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FOUR-DIMENSIONAL GUIDANCE ALGORITHMS FOR AIRCRAFT IN AN 


AIR TRAFFIC CONTROL ENVIRONMENT 
Thomas Pecsvaradi 
Ames Research Center 


SUMMARY 


This report describes the detailed theoretical development of three 
guidance algorithms that form a part of an experimental 4-D guidance system. 

The algorithms generate the ground track, altitude profile, and speed profile 
required to implement the 4-D guidance concept. 

The ground track algorithm computes a realistic, flyable ground track 
consisting of a sequence of straight line segments and circular arcs. Each 
circular turn is constrained to have a radius at least as large as the minimum 
turning radius of the aircraft. The altitude profile algorithm generates an 
altitude profile along the previously computed ground track. The altitude 
profile consists of a sequence of piecewise constant flight-path angle seg- 
ments, each segment lying within specified upper and lower bounds. Finally, 
to determine the motion of the aircraft as a function of time along the 3-D 
flight path, the speed profile algorithm generates a feasible speed profile 
subject to constraints on the rate of speed change, permissible speed ranges, 
and the effects of wind. The various flight path parameters are then combined 
into a chronological sequence to form the 4-D guidance vectors. These vectors 
can be used to drive the autopilot/autothrottle of the aircraft, so that a 
4-D flight -path can be tracked completely automatically; or these vectors may 
be used to drive the flight director and other cockpit displays, thereby 
enabling the pilot to track a 4-D flight path manually. The system has a 
number of unique features that aid in achieving precise arrival times: the 

ability to capture any one of the waypoints along the flight path, the ease 
with which the tracking mode (both automatic and manual) can be engaged and 
disengaged, and the provision for manual path stretching as part of the overall 
4-D guidance scheme. 

The three guidance algorithms have been implemented in the form of a set 
of computer programs and these programs have been tested extensively in a 
static environment on the IBM 360/70 computer at Ames Research Center. 


INTRODUCTION 


Accurate terminal area guidance and control can be achieved with a system 
concept referred to as 4-D guidance. During the last several years at Ames 
Research Center, effort has been devoted to the design, development, and 
implementation of an experimental 4-D guidance system. The system uses a 



technique to guide and control an aircraft not only in the three spatial 
dimensions, but in time as well. The aim of the technique is to provide a 
flexible guidance scheme that can be used to predict and control accurately 
the motion of an aircraft as a function of time. It must be emphasized that 
the technique by itself is not sufficient to solve the complete multi-aircraft 
terminal area guidance problem, for which many aircraft must be scheduled and 
sequenced into common paths while minimum separation standards are assured. 

The problem of aircraft scheduling has been discussed by McLean and Tobias 
(ref. 1), who developed an interactive real time system for scheduling and 
monitoring many aircraft in the terminal area. An overall terminal area 
guidance system that uses both the 4-D algorithms presented here and the 
scheduling algorithms described in reference 1 appears to have a great poten- 
tial for increasing terminal area effectiveness. 

Research in 4-D guidance is currently under way by the Department of 
Transportation, universities, and NASA. However, publications on alternate 
approaches are not generally available. One possible alternate approach that 
has been published is path stretching in a defined terminal area corridor 
(ref. 2) . 

This report describes the detailed theoretical development and computer 
implementation of those algorithms that generate the 4-D reference flight 
path. Specifically, three main guidance algorithms are developed: the first 

generates the ground track of the reference flight path, the second calculates 
the altitude profile, and the third computes the desired speed profile. A 
feasible method of combining the three algorithms into an on-line 4-D guidance 
system is also described. Certain general aspects of some of these algorithms 
are extensions of earlier work done at Ames; the particular techniques used to 
generate the ground track and speed profile, however, represent new contribu- 
tions. The design of the algorithms is modular so that many of the sub- 
algorithms can be used independently or can be replaced with a minimum effect 
on the overall system. 

The algorithms are implemented in the form of a set of computer programs. 
These programs were written in FORTRAN IV and were tested on the IBM 360/70 
at Ames. Detailed programming descriptions of all subroutines, including flow 
charts and source listings, are given in the appendix. 


PROBLEM DESCRIPTION AND BASIC APPROACH 


The fundamental problem facing controllers and pilots in the terminal 
area is the safe and efficient guidance and control of aircraft from various 
points in the terminal area to the runway. (The problem of safe and efficient 
guidance of departing aircraft is just as important; however, since the basic 
guidance tasks in the two cases are quite similar, it is sufficient to consider 
the guidance tasks associated with approaching aircraft in developing a theo- 
retical framework.) This task consists of two separate subtasks: 

(i) selecting a 3-D flight path the aircraft is to follow and a time schedule 
to be maintained along the flight path, and (ii) controlling the aircraft along 
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the 4-D flight profile determined in (i) . In the current air traffic control 
(ATC) system, subtask (i) is generally considered to be the responsibility of 
the controllers. Selecting terminal area flight paths is made considerably 
simpler by the existence of Standard Terminal Arrival Routes (STARS) and 
Standard Instrument Departure (SID) routes. Portions of these routes, com- 
bined with certain less well-defined paths determined at the time of flight 
and transmitted to the pilot in the form of a series of verbal instructions 
(vectoring), comprise the majority of terminal area flight paths. Thus, 
selecting three-dimensional terminal area flight paths is reasonably straight- 
forward. The determination, in advance, of a desired -time schedule along such 
paths, on the other hand, is much more difficult since it requires knowledge 
of the ground speed of the aircraft as a function of time, which, in turn, 
must be integrated to give position information. Clearly, accomplishing such 
a task manually is very difficult, especially in a multi-aircraft environment. 

Tracking a predetermined four- dimensional flight profile is, of course, 
the responsibility of the pilot. This task can be carried out either manually 
or automatically, using the ^autopilot/autothrottle of the aircraft. One of 
the major shortcomings of current autopilots is, however, their limited capa- 
bility of tracking complex, four-dimensional flight profiles. Although most 
autopilots can perform such single functions as altitude hold, heading hold, 
flight-path- angle hold, etc., they are not designed to perform a sequence of 
such operations automatically. Similar comments apply to the autothrottle. 
This report describes the development of a guidance technique that is suffi- 
ciently flexible to permit manual or automatic tracking of complex four- 
dimensional flight paths. 

Most flight paths of aircraft can be modeled as sequences of straight- 
line flights and coordinated turns, executed while flying at piecewise con- 
stant flight-path angles. Speed changes occur at relatively few points along 
the flight path and are usually accomplished at a nearly linear rate. The 
principal control signals used to maneuver aircraft along such typical flight 
paths are bank angle, flight-path angle, and acceleration of the aircraft. It 
is assumed throughout the report that the flight-path angle is small, the 
centrifugal force due to the turn is balanced by the horizontal component of 
the lift, and the weight of the aircraft is balanced by the vertical component 
of the lift. It is further assumed that the speed of the aircraft is directly 
controllable by an acceleration input. Under these assumptions, no sideslip 
occurs and the point-mass equations of motion of an aircraft can be written as 


X ~ V cos 


(1) 

y = V sin 


(2) 

z = vy 


(3) 

tan 


(4) 

V = a 


(5) 
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where x, y, and z are the Cartesian coordinates of the aircraft position in 
the usual z- downward-positive coordinate system, is the heading angle 
measured clockwise from the positive x-axis, v is the speed, <ji is the bank 
angle, y is the flight-path angle, a is the acceleration of the aircraft, 
and g is the acceleration due to gravity. Positive <t>, by convention, means 
right wing down, which corresponds to a right turn; similarly, positive y 
means ascending flight. The quantities x, y, z, \j>, v are considered to be 
the state of the aircraft, while y, and a are the controls. 

In order to assure passenger comfort and to remain within the safe 
operational characteristics of the aircraft, it is necessary to impose con- 
straints on the control variables. Accordingly, y, and a are assumed to 
satisfy the following constraints: 


1 <t> (t) j s 't^inax 

(6) 

Ymin ^ ^ ^max 

(7) 

^in ^ ^ ^ax 

(8) 


These bounds, of course, depend a great deal on the type of aircraft con- 
sidered. For a typical jet transport aircraft, extreme values of these bounds 

may be 4'max ~ 30°, ymin ~ "3°, ymax ~ ® > ®min ~ -0.6 m/sec^, ^ 

^ax =0.6 m/sec^; for STOL aircraft, may be as low as -8 . 

In addition, bounds must be placed on the admissible speeds of the air- 
craft. The upper bound is generally dictated by either Federal Aviation 
Regulations or by structural considerations, while the lower bound depends 
basically on the stall characteristics of the airplane. A more detailed 
discussion of the speed constraints is given under Speed Profile. For the 
present general discussion, it is simply assumed that the speed of the air- 
craft satisfies constraints of the form 

Vmin ^ v(t) < v^ax 


It is convenient at this point to introduce a change of variables in 
equation (4), When the ground track of an aircraft is considered, the 
instantaneous radius of curvature, r, of the flight path is defined by (see 
ref. 3) 


V _ v^ 

• " g tan <t> 


( 10 ) 


Thus, the radius of curvature is closely related to the bank angle. For pur- 
poses of analysis, it is convenient to consider r, rather than <j), as the 
principal control variable used for horizontal maneuvers. Actually, to avoid 
infinite values during the control process, a more appropriate control 
variable, u, is defined as follows 
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u 


= i . g ill) 

T 

In terms of the control variable u, equation (4) can be rewritten as 

t = vu (4’) 

Since 4 and v are constrained by inequalities (6) and (9), respectively, 
the admissible values of u are bounded from above and below. Thus, given any 
instantaneous speed, say v(t), along the flight path, the instantaneous value 
of u(t) must satisfy the inequality 


u(t) 


g ‘i’max 
- v^Ct) 


C12) 


It can now be seen why u is a particularly convenient control variable 
for accurate aircraft guidance: a constant nonzero u yields a ground track 

with constant radius of turn, that is, a circular flight segment. Furthermore, 
if u E 0, then the ground track of the resulting flight is a straight line. 
Hence, if piecewise constant values are used for u, simple yet realistic 
ground tracks can be generated. Piecewise constant values of u can be 
obtained by appropriately varying <|)(t) according to equation (11). 


While inequalities (6) through (8) constrain the admissible magnitudes 
of the control variables 4>, y, and a, the rates at which these variables are 
allowed to change are not limited. It is recognized that, in reality, these 
controls can change only at finite rates. It is felt, however, that the 
assumption of infinite control rates is not at all unreasonable for a guidance 
technique whose purpose is to generate four-dimensional terminal-area flight 
paths for periods of time that can be several orders of magnitude greater than 
the time constants of the controls. Furthermore, the inclusion of rate con- 
straints on the controls would result in a much more complicated problem and 
would make the implementation of the results much more difficult. In view of 
these remarks, the control rates are assumed to be unlimited. Under Four- 
Dimensional Guidance Commands, a simple but effective way of accounting for 
finite roll and pitch rates is described. 

Before stating the precise problem to which this report is addressed, :i,t 
is instructive to look at the states and controls that corresppnd 'to-.. a typical 
terminal area flight path. Figure 1 shows the ground track 'of an aircraft" ‘ 
from an arbitrary point A to the touchdown point K. The ground track consists 
of a series of connected straight lines and circular arcs. The altitude, 
speed, and heading profiles corresponding to this ground track are shown in 
figure 2; figure 3 illustrates the controls required for the flight path 
depicted in figures 1 and 2. At point A, the aircraft is flying straight and 
level but begins to decelerate to a lower speed. This lower speed is achieved 
at point B, so that the flight from B to C is straight and level at constant 
speed. At point C, the '^aircraft begins to descend to a lower altitude at 
some constant, negative flight-path angle. While continuing the descent, at 
D it begins a left turn, capturing the new required heading at point E. From 
E to F, the flight is straight at constant speed but is still descending. At 
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Figure 3.- Control signals for flight profile of figures 1 and 2 






F, the required altitude is achieved, so the aircraft levels off, maintaining 
a straight and level flight at constant speed between F and G. At point G, 
the aircraft begins to decelerate to the final approach speed, while at 
point H it begins a right turn, all at level flight. At point I, the runway- 
centerline is intercepted and the final approach speed is achieved simultan- 
eously. At this point, the aircraft begins its straight-in approach. At 
point J, transitioning occurs from level flight to capture the glide slope, 
and the approach is continued until touchdown at point K. 

In the current ATC system, the above guidance process is basically a 
manual one: the controller transmits the commands to the pilot via radio- 

telephone, and the pilot then executes these commands by appropriately 
maneuvering the aircraft. Two major limiting factors in such a manual 
guidance-control loop are the great deal of communications required and the 
lack of accuracy with which arrival times to the runway can be predicted. 
However, both limitations can be reduced substantially by use of airborne 
digital computers, sophisticated cockpit displays, and a digital data-link 
between ground and aircraft. These considerations are incorporated in the 
development of the guidance scheme presented here. 

The point of view adopted in this research was that the fundamental 
problem of aircraft guidance is to generate a time sequence of guidance com- 
mands corresponding to a desired four-dimensional flight path. That is, if a 
set of realistic guidance commands could be identified for any terminal area 
flight path, then the commands could be either coupled to the autopilot/ 
autothrottle of the aircraft for automatic tracking, or they could be pre- 
sented on appropriate displays to the pilot for manual tracking. Since the 
problems associated with tracking a sequence of guidance commands have been 
treated elsewhere (see, e.g., refs. 4 and 5), they are not discussed here. 

The first question to be resolved is: what is a minimum set of simple 

inputs from which realistic guidance commands could be synthesized by an effi- 
cient algorithm? To answer this question it is necessary to determine those 
attributes of a 4-D flight path which are essential to describe it uniquely. 
Consider the three spatial dimensions, that is, the 5-D path. As far as the 
horizontal projection of typical flight paths is concerned, aircraft generally 
navigate from point to point (referred to as waypoints) in straight-line seg- 
ments (fig. 1). At or near these waypoints, coordinated turns are executed to 
capture the new heading of the next straight flight segment. Thus, the ground 
track of an arbitrary flight path could be simply characterized by the 
x,y coordinates of these waypoints in some coordinate system. Since aircraft 
cannot change heading instantaneously, feasible turning radii should be 
specified for the turns at the waypoints. A sequence of x,y coordinates and 
turning radii alone, however, does not yield a unique ground track and there- 
fore additional logic is required. As shown in the next section, two simple 
classes of waypoints can be defined so that a unique ground track is obtained 
by specifying the following four input quantities for each waypoint: x,y 

coordinates, turning radius, and a binary variable that denotes the class to 
which the waypoint belongs. 
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As discussed previously> the motion of aircraft in the vertical dimension 
can be considered a sequence of constant altitude and constant flight-path- 
angle segments (fig. 2). Therefore, arbitrary altitude profiles can be 
uniquely determined by specifying the altitudes of those points along the 
flight path at which the flight -path angle changes from one constant value to 
another. To synthesize altitude profiles, it is assumed that the flight-path 
angle can change from one constant value to another instantaneously. A 
simple method of accounting for finite pitch rates is discussed under Four- 
Dimensional Guidance Commands. 

Having specified a complete 3-D flight path in the manner described 
above, it now remains to characterize the motion of an aircraft as a function 
of time along the prespecified 3-D path. This is equivalent to characterizing 
the velocity profile along the flight path. Due to operational constraints, 
aircraft performance limitations, and the desire to control accurately the 
arrival times of aircraft, the problem of specifying feasible velocity pro- 
files is difficult. It is further complicated when velocity profiles are to be 
specified in the presence of wind. It is shown, however, under Speed Profile, 
that judicious approximations can be made and realistic speed profiles can be 
synthesized from a small number of input parameters. 

The flow of computation in the 4-D flight-path synthesis is sequential 
and is illustrated by the block diagram in fig. 4. The first step is to 
generate the ground track from the given inputs. The ground track is then used 
together with additional input parameters to compute a feasible altitude pro- 
file. At this point, a 3-D path and the corresponding 3-D guidance commands 
are determined. The last step is to generate a feasible speed profile that 
satisfies the arrival time requirements. A detailed description of the 
ground track synthesis is given in the following section, the altitude profile 
generation is described under Altitude Profile, and the speed profile generat- 
ing algorithm is discussed under Speed Profile. 


GROUND TRACK SYNTHESIS 


The ground track of a typical terminal area flight path consists of an 
alternating sequence of straight lines and circular arcs. The transitions from 
one straight-line flight to another with different heading occur at or near 
points called waypoints. For example, a typical flight segment might be a 
straight flight toward a VOR station along an inbound VOR radial, followed by 
a straight flight on a different outbound radial. The transition from one 
heading and the capture of the new heading occurs near the VOR station. In 
this example, the VOR station can be considered a waypoint. Note, in this 
case (as in many situations), there is no compelling reason for the aircraft 
to fly directly over the waypoint. Since area navigation procedures make it 
possible to offset VOR stations in a nearly arbitrary fashion, this type of 
waypoint could be defined abundantly in the terminal area. 

A different situation exists when an aircraft, after a period of straight 
flight, is required to fly over a waypoint and capture a new heading 
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4-D guidance 
commands 


Figure 4.— Four-Dimensional Guidance command synthesis. 







simultaneously. Such a waypoint might be the outer marker or the approach 
gate. It may also be any waypoint at which two or more flight paths merge and 
continue along a common path. 

It is observed that the ground tracks corresponding to many terminal area 
flight paths, and indeed most of the enroute flight paths as well, can be 
characterized by these two types of waypoints. Consequently, the following 
waypoint definitions are made. 


Ordinary Waypoint 

Figure 5(a) is a graphical illustration of an ordinary waypoint where the 
ground track of a flight-path segment corresponds to a straight-turn-straight 
sequence from point WP^, via point WP2 to point WP3. The aircraft at 
point WP, is flying at a heading ifi, directly toward point WP2* Prior to 
reaching WP2, at point P2, a circular turn of radius is begun and is 

continued until, at point Q2, the new desired heading, is achieved. If 

such a ground track between points WP^ and WP3 is to be obtained by specify- 
ing the x,y coordinates of W?2 and the desired turning radius, then WP2 
is defined as an ordinaiy waypoint. (This definition does not imply that 
points WPi and/or WP3 are ordinary waypoints.) Clearly, any straight-tum- 
straight sequence can be specified by an ordinary waypoint as long as the 
angular extent of the turn is less than 180®. Stated in a different form, if 
the intersection of two straight directed line segments is considered to be an 
ordinary waypoint, then the ground track of the resulting straight- turn- 
straight sequence is uniquely determined (assuming, of course, that the 
desired turn radius, R2, is also specified). 


Final Heading Waypoint 


A final heading waypoint is one over which the aircraft just completes a 
turn and captures the desired heading of the next straight-line segment. This 
situation is illustrated in figure 5(b), which shows an aircraft at point WP^ 
flying toward point ?2 at a heading >p2* appropriate turn of 

radius R2 is begun and is continued until, precisely at point ^^ 2 ’ 
desired heading is achieved. If the ground track between points WP^ 

and WP„ is generated in this manner, then WP2 is defined as a final heading 
waypoint. (This does not imply that point WPj is a final heading waypoint.) 
The essential quantities to be specified for a final heading waypoint are the 
x,y coordinates of WP the heading if<3 from WP2 to the next point, say 
WP3, and the radius of turn, R2, at W?2. It follows from the above definition 
that, if the ground track of a straight- turn-straight sequence is specified by 
a final heading waypoint, then the initial heading, and the point P2 
where the aircraft initiates the turn must be computed from geometric con-^ 
siderations. Note that it is possible to generate a turn greater than 180® 
by using a final heading waypoint. 

It is clear from the above definitions that any ground track consisting 
of a sequence of straingt-line segments and circular arcs can be uniquely 
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generated by merely specifying the appropriate sequence of waypoint parameters. 
What is required is an algorithm to calculate those parameters of the ground 
track that are not specified explicitly. Thus, for an ordinary waypoint, such 
as WP„ in figure S(a), only the x,y coordinates of the points WP^, WP^, 
and WP3, along with the turn radius R^, would be specified explicitly; all 
other parameters shown in figure 5(a) need to be computed. For a final head- 
ing waypoint, such as WPg in figure 5(b), only the x,y coordinates of 
points WPj and WP2, along with the turn radius R, and the desired waypoint 
heading i{/,, would be specified explicitly; the other parameters shown in 
figure 5(b) must be computed. 

It is convenient to partition the algorithm into two parts, one for each 
of the two types of waypoints. Before the overall algorithm is presented, the 
two separate subalgorithms are described in detail. 

First, consider an ordinary waypoint. Referring to figure 5(a), assume 
that the x,y coordinates of the points WP^, WP2, WP^ are given by 
(XWPj,YWP^), (XWP2,YWP2), and (XWP3,YWP3), respectively. Then the headings 
and are given by 
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By convention, the direction of the turn is to the right if Ai(j 2 is positive 
and to the left if negative. Since -ir < \p2» '^'3 ^ given by equa- 
tion ( 15 ) lies within the range -ir < < tt. 

Once is calculated, the expression for C2 (see fig. 5 (a)) is 

obtained in terms of A\ji^ and the radius R2: 



The lengths of the two straight segments, D2 and D^, are then given by 

D2 = [(XWP2 - XWPj )2 + (YWP2 - YWPj)2]1/2 . 


( 18 ) ^ 


( 19 ) 


D3 = [(XWP3 - XWP2)2 + (YWP3 - - C2 


( 20 ) 


It is now a simple matter to determine (XP2,YP2) and (XQ2,YQ ), the x,y 
coordinates of the beginning and end of the turn, respectively: 


XP2 

= XWP2 

- C2 • 

COS 


Y ?2 

= YW ?2 

- ^2 • 

sin 


XQ2 

= XWP2 


cos 

h\ 

YQ2 

= YWP2 

. C2 * 

sin 



( 21 ) 


( 22 ) 


It is important to recognize that, since the locations of points WP^^, 
WP2, WP, may be completely arbitrary, it is possible to specify them in such 
a way that D2 or or both (as given by eqs. ( 19 ) and ( 20 )), are negative. 
Negative D„ and/or Dg implies that WP^ and/or WP^ is too close to the 
waypoint WP2 for the given turning radius. The implications of this situa- 
tion, and possible remedies for it, are discussed later in this section. 


The above computational procedure is well suited for computer implementa- 
tion as a separate subroutine. Accordingly, a subroutine called ROUND has 
been written and is described in more detail in the appendix. 

Consider a final heading waypoint such as shown in figure 5 (b). It is 
assumed that the following quantities are specified: (XWPj^,YWPj) and 

(XWP2,YWP2), the x,y coordinates of the points WP^ and WP2; 'I'g, the desired 
heading at WP2; and R2, the radius of turn. The parameters to be determined 
are the heading \jj and length D2 of the straight flight segment, the x,y 
coordinates (XP2,YP2) of point Pg, and the direction and magnitude of 
turn Ai^2 • 
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with th© solution > it is infonn&tiv6 to consider thxs 
prohlcin from & different point of view* Consider nn siremft locnted nt point 
W?2 with a heading ^i^3 (see fig. 6) given by 

4 .^ = M0D^(4/3 + it) (23) 

(for an arbitrary angle 4» expressed as the sum ij; = 4»j„ + n • tt such that 
-TT < If)-, < TT and n is an integer, MOD^Cif') = J . Assume that the aircraft 
is to fly directly to point WP, in such a manner that the path length of the 
corresponding ground track is minimized subject to the minimum turning radius 
constraint R,. The resulting ground track is seen to be precisely the solu- 
tion to the original problem, except that the aircraft will actually fly it in 
the reverse direction, that is, from WP^ to WP^. This type of minimum path- 
length guidance problem was first proposed in reference 6, where the appro- 
priate switching functions for the control law were calculated. A modified 
solution to the problem is given here, one particularly suitable for computer 
implementation . 

Define ^’^'2 

= M0D,,(4)2 + tt) (24) 

ATp2 = -Aifi2 (2^) 

and let (X0,Y0) denote the x,y coordinates of the center of the turn, 
point 0. Using certain geometrical arguments, the expressions for (X0,Y0) are 

XO = XW?2 - R2 • SIGN • sin 4-3 (26) 

YO = YWP2 + • SIGN • cos 4)3 (27) 

where SIGN is defined as 

SIGN = SGN[(YWPj - YWP2 )cos 4*3 - (XWP^ - XWP2)sin 4-3] (28) 

The length, D2, of the straight-line segment is then 

D 2 = [(XWPj - X0)2 + (YWPj - YO)^ - R2^]^^^ (29) 

and the expressions for angles a^, a^, and (see fig. 6) are 

= M0DTr(V'3 " SIGN • J) (30) 
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Once a-,, and ct^ are known, the direction and angular extent of the turn 
can be^expressed as 

/ 


C33) 


where the expression for SIGN is given by equation (28). The heading, 
of the straight-line segment and the x,y coordinates (XP 2 ,YP 2 ) of point 
are obtained in a straightforward fashion: 



“2 - 

“1 

- SIGN • 

+ 2tt, 

if 

SIGN > 

0 

and < a 

Ai(<2 = ' 

“2 - 

“1 

- SIGN • 

«3 - 2ir, 

if 

SIGN < 

0 

and > a 


“2 - 

“1 

- SIGN ♦ 

“3 

otherwise 






(34) 


XP^ = XO + ' SIGN * sin "j 

> (35) 

YP 2 = YO - R 2 ' SIGN • cos ^2 I 

The desired parameters of the original final heading waypoint problem 
are now easily derived. In fact, the solution to the modified problem yields 
the length of the straight flight segment and the x,y coordinates of the 
beginning of the turn, point P^. The heading i |'2 obtained from by 

= MOD^(<i«^ + ir) (36) 

and the direction and magnitude of the turn A\li 2 are given by equation (25), 
that is. 


A \|>2 = -A>I*2 

As in the case of ordinary waypoint, it is possible to specify a final 
heading waypoint in such a way that the radicand in equation (29) is negative. 
This condition implies that, for the given waypoint location, desired final 
heading, and minimum turning radius, point WP is too close to waypoint W ?2 
Action to correct this condition is discussed later. 

A subroutine called NEWPSI has been written to compute the various 
parameters associated with a final heading waypoint problem. This subroutine 
is described in more detail in the appendix. 


Ground Track Computation 

Using the definitions of ordinary and final heading waypoints, along with 
the computational subalgorithms described previously, an algorithm is now 
described that generates a complete two-dimensional ground track from a 
sequence of specified waypoints. A crucial idea in the algorithm is that it 
generates the ground track by processing the waypoints in reverse order, 
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beginning with the last waypoint and proceeding sequentially until the first 
waypoint is processed. This procedure makes it possible to generate the 
required headings at final heading waypoints automatically, thereby eliminat- 
ing the need to specify these headings explicitly as separate input data. The 
only exception to this is the last waypoint (always assumed to be a final 
heading waypoint) , which requires that the value of the desired final heading, 
denoted by '['final* specified explicitly. This assumption is consistent 
with usual terminal area operational procedures. Placing the last waypoint on 
the extension of the runway centerline, declaring it to be a final heading 
waypoint, and specifying the runway heading as the desired heading assures 
that the aircraft is guided to the localizer and is properly aligned with the 
runway at some point prior to landing. Such a final waypoint could be the 
approach gate, the outer marker, or any other point on the ri^way centerline 
beyond which 4-D control of the aircraft is either inappropriate or not 
desirable. For example, based on the nominal landing speed of the aircraft, 
the last waypoint may be 1 minute of flight from touchdown. 

Consider a sequence of NWP waypoints, denoted by WP^, i = 1,2,...,NWP, 
and let the following parameters be given for each waypoint: 

XWPj^,YWp£ x,y coordinates 
turning radius 

INDEX^ type of waypoint 

The x,y coordinates are given in a runway- centered coordinate system, 
in which the x-axis coincides with the runway centerline and is positive in 
the direction of landing, the y-axis is perpendicular to the runway and posi- 
tive to the right, and the origin is at the touchdown point. What might be a 
sequence of five waypoints for the ground track of an arriving aircraft is 
shown in figure 7. The dashed lines represent the idealized ground track the 
aircraft would follow if it could change heading instantaneously at the 
waypoints. 

The turning radius may or may not be explicitly specified as an 

input. If it is not specified, then the minimum turning radius is computed 
based on the maximum admissible bank angle and maximum possible ground speed 
at waypoint i, and is set equal to this minimum turning radius. If Rj 

is specified as an input, then the minimum turning radius is computed as 
described above and is compared with Ri: if Ri is greater than or equal to 
the minimum feasible turning radius, then processing continues; otherwise, an 
error message is generated and processing stops. For the remainder of this 
section, Ri is assumed to be greater than or equal to the respective mininium 
feasible turning radius for all i = 2, 3,..., NWP. (The computation of the 
minimum turning radius is discussed at the end of this section. 

The input parameter INDEXi is a binary variable whose value is 0 or 1. 
INDEXi = 0 Implies that waypoint i is an ordinary waypoint, while 
INDEX- = 1 means that waypoint i is a final heading waypoint. As mentioned 
earlier, the last waypoint is always a final heading waypoint, that is. 
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/ 


INDEX]^^n[p = 1 . The first waypoint is also treated as a final heading waypoint, 
although as will be shown, this is not necessary and is merely a convention. 
All other waypoints may be chosen as ordinary or final heading type, so that 
{INDEXi}, i = 2,3, . . . ,NWP-1, is a completely arbitrary sequence of O's 
and 1 ' s ■ 


Assume that the algorithm has processed waypoints NWP, NWP-1, i + 1, 

and is currently to process waypoint i. At this stage of the algorithm, the 
following quantities are available for all j = i + 1, i + 2, .... NWP: 

ipj heading of straight flight segment from WPj_j^ to point Pj 

(XPj,YPj3 x,y coordinates of P j , the point where the turn associated 

with waypoint j begins 


angular extent of turn associated with waypoint j 

CXQj,YQj) x,y coordinates of Q j , the point where the turn associated 
with waypoint j ends 

Now assume that waypoint i is an ordinary waypoint, that is, INDEX^ =* 0 
(see fig. 8 ). Then, from figure 5(a), point WP^ is replaced by WPj^_j, 

WP^ by WP^, and WP 3 by Pi+^, and the subroutine ROUND is called to compute the 
above parameters for waypoint i. The expressions for these parameters are 
essentially the same as equations (13) through (22) , but are repeated below 
for completeness: 




/YWPi - YWPi.^V^ 

\^XWPi - XWPi.j^ ’ 


= tan" 

SIGN = SGN[(YPi+j - YWPi)cos <1/^ - (XPj+i 
( ’('i+i “ V'i , if SIGN > 0 


AiPi 


'I'i+i 

I'J'i+l 


- - 2tt , if SIGN < 0 


’I'i 


otherwise 




/ 

''i Aij/J 

l\ 

Ci 

= Ri • 

tan 1 


") 

XP^ 

= XWP^ 

' q 

COS 

ti 

YPi 

= YWPi 

- Ci 

sin 

H. 

XQi 

= XWP^ 

" Ci 

cos 


YQi 

= YWP^ 

" Ci 

sin 



< < ii 

- XWP^)sin 

and 

and 


(38) 

(39) 

(40) 

(41) 

(42) 

(43) 
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If waypoint i is a final heading waypoint, then INDEXj = 1 (fig. 9). 

In this case, from figure 5(b), point WP^ is replaced by W ?2 by WPjj^, 
?2 by Pj^, and the subroutine NEWPSI is called to generate the following ground 
track parameters: 


’I'i+l = + tt) 

SIGN = SGN[(YWPi_^ - YWPi)cos - (XWP^_^ - XWP^)sin 

XO = XWPi - • SIGN • sin 

YO = YWPi + Ri • SIGN • cos 

Dj^ = [(XWPi.j - XO)2 + (YWP^.j - Y0)2 - R3^2 j1/2 

- SIGN • ^ 

/YWPi.j - YO\ 

^ \XWPj_j - xoi ’ 


= tan 


-IT < 02 < 7T 


Alf'i = -'i'I'i 

+ Aif.!) 

= MOD^(\J)[ + ir) 

XPj = XO + Ri • SIGN • sin 
YP^ = YO - Ri • SIGN • cos i|/| 


(44) 

(45) 

(46) 

(47) 

(48) 

(49) 





Og = tan"^ 1 



• 


(50) 


“2 - 

“l 

- SIGN *02+2^, 

if 

SIGN > 

0 

and 02 < Oj 


A^! =. 

«2 - 

“l 

- SIGN • Og - 27r , 

if 

SIGN < 

0 

and 02 > 

(51) 


“2 - 

“‘l 

- SIGN • Og 

otherwise 





(52) 

(53) 

(54) 

r> 

(55) 


( 56 ) 


XQi = XWPi 
YQi^ = YWPj 
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In order to describe the two-dimensional ground track completely, it remains 
to determine the length of the straight flight segments and the arclength of 
the turns. Let Dj^ denote the length of straight flight from point Qj[_x to 
point and let represent the arclength of the turn 

i = 2,3,...,NWP. Then the expressions for and AD^ are 

Di = [(XP^ - + (YPi - (57) 

AD^ = Ri * k'J'il (58) 


Minimum Turning Radius 

In order to compute the minimum turning radius at each waypoint, it is 
necessary to know the maximum ground speed of the aircraft at the waypoint and 
the maximum permissible bank angle. The speed profile of the aircraft, how- 
ever, is not known when the ground track is generated. Consequently, the 
maximum ground speed must be approximated to compute the minimum turning 
radius. In order to assure that at no waypoint will the guidance commands 
require the aircraft to violate the maximum bank-angle constraint, the maximum 
ground speed at each waypoint is taken to be the scalar sum of the maximum 
possible airspeed at the waypoints and the wind magnitude. The maximum pos- 
sible airspeed, in turn, is a function of the maximum permissible airspeed at 
the last waypoint and the distance along the flight path to the last waypoint. 

Let V denote the maximum admissible airspeed in the terminal area, v^ 
the magnitude of the wind, and VCMAX^ the maximum possible ground speed of 
the aircraft at waypoint i. Since the airspeed to be achieved at the last 
waypoint is specified as VCMAX^wp = Vfjnal 5or i < NWP, 

VGMAXj^ is approximated by the following (see sketch (a)). 



Vgmax.^j , 

if 

VGMAXi+i = V + v^^ 


VGMAXi = - 

V + V„ , 

if 

VGi s V + v^^ 

(59) 


.VGi 

otherwise 



where the expression for is 

VGi = jvGMAXf+j - 2 • - XWPi)^ + (YP^^^ - YWPi)2]i/2j 

The physical interpretation of VGi is as follows: if the aircraft were to 
fly directly from waypoint i to point Pi+x and apply the maximum decelera- 
tion then it could just achieve a ground speed change from VGj^ at 

point WPjj^ to VGMAXj^+X . at point Pi+x* Note how equations (59) and (60) 
reflect the assumption that the upper envelope of the admissible speeds 
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Sketch (a) . 


decreases monotonically as the aircraft approaches the last waypoint. Specifi- 
cally, if for some value of i, say i = j> VGMAXj - v + v„, then 
VGMAX^.j * VGMAXi = v + v^, for all i < j. 

Once VGMAXi is knovm, the minimum turning radius, RMIN^, at waypoint i 
can be computed from 


RMINj^ 


VGMAXj 2 

g * tan 


C61) 


ALTITUDE PROFILE 


Except for the very last phase of flight, namely flaring and decrabbing, 
the motion of an aircraft in the vertical plane consists of constant flight- 
path- angle segments connected by some sort of smooth transitioning between 
adjacent flight-path angles. To generate an altitude profile, it is assumed 
that transitioning from one flight-path angle to another is instantaneous. 
Whatever inaccuracy results from this assumption is minimized by introducing 
appropriate lead times in the actual control law. This method of compensating 
for finite pitch rate is discussed under Four-Dimensional Guidance Commands. 

The basic assumption in generating an altitude profile is that the flight- 
path angle between adjacent waypoints remains constant. Thus, in order to 
generate the constant flight-path-angle segments, the desired waypoint alti- 
tudes and the horizontal distance between each pair of adjacent waypoints must 
be known. 

In using waypoint altitudes to generate a sequence of constant flight- 
path angles, the following ambiguity must be resolved: ordinary waypoints do 
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not lie on the actual flight path generated by the techniques described pre- 
viously; consequently, the meaning of waypoint altitude for ordinary waypoints 
must be defined. Therefore, it is assumed, somewhat arbitrarily, that the 
waypoint altitude should be achieved precisely at the end of the turn asso- 
ciated with the waypoint in question. Note that this is entirely consistent 
with the definition of final heading waypoints. Thus, if 2WP^, i * 1, 2, 

NWP, are the desired waypoint altitudes, then ZWPj is actually the 
altitude of the aircraft at the point when the turn associated with WP^ is 
completed. Since the end of a turn at WPj^ is denoted by point Qj, the 
altitude, 2Qj_, at point Qi is therefore given by 

= ZWPj^ , i = 1 , 2 ,..., NWP (62) 

The horizontal distance between points Qi-j Qi already been 

computed and is simply the sum of the straight flight distance and the 

arclength of the turn at WP^, that is, ADj. If the constant flight-path 
angle between points Qi_i 3^nd Qj^ is denoted by GAMj^, then the expression 
for GAMi is (fig. 10) 


GAMj^ = tan"^ 



Note that since the vertical axis is positive downward by convention, GAM^ > 0 
implies ascending flight, while GAM^ < 0 implies descending flight. 

For sufficiently small values of its argument, the function tan"^(0 
can be approximated to a high degree of accuracy by its argument. Since the 
argument of tan“^(*) in equation (63) is generally quite small, and since 
evaluating tan"^(*) requires a relatively long execution time, for the com- 
puter implementation of the guidance scheme, the value of GAMj is computed 
from the approximate expression 


ZQi.i - zQi 


D. + AD. 
1 1 


(64) 


Computing the sequence of flight-path angles according to equation (64) 
is straightforward. It is conceivable that GAMj^ (as given by eq. (64)) may 
be either infeasible from an aircraft performance point of view or undesirable 
due to other operational constraints. Therefore, GAMj^ must be checked . 
whether it satisfies the constraints 


Y • 5 

min 


GAM^ 


< Y 


max ' 


i = 2, 3,,.., NWP 


(65) 


where Ymin Y'max input parameters. If GAM^ satisfies 'inequaTities 

(65), then computation continues; otherwise, a message is geprated stating 
that GAMj_ lies outside the admissable range and computation stops. 
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Figure 10.— Altitude profile synthesis. 
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For a complete altitude profile, it remains merely to determine what the 
altitude should be at the beginning of each turn, that is, at the points P^. 
Let 2Pj^ denote the altitude at point then ZP^ is given by 

ZPi = • GAMj^ (66) 

A typical altitude profile between two arbitrary points ^nd is shown 

in figure 10. 


SPEED PROFILE 


The primary objective of the 4-D guidance system described here is to 
guide the aircraft accurately not only in the three spatial dimensions, but 
also to control its motion as a function of time along the desired flight 
path, thereby controlling the time of its arrival at the end of the flight 
path. Thus, after the desired 3-D flight path is computed, it is necessary 
to determine a time schedule the aircraft is to maintain along the flight 
path. This, in turn, requires the determination of an appropriate speed 
profile. 

Clearly, if the speed profile of the aircraft were specified rigidly, 
then so would its motion as a function of time along the flight path, in which 
case control of its arrival time would not be possible. While the admissible 
speed is not entirely arbitrary, at almost every point during the flight there 
exists a definite range of speeds within which the aircraft may operate. 


Admissible Speed Ranges 

As mentioned briefly under Problem Description and Basic Approach, the 
maximum admissible speed of an aircraft is dictated by either Federal Aviation 
Regulations or by structural constraints. FAR 91.70a limits all aircraft to 
an indicated airspeed of 250 knots below 3048 m (10,000 ft) mean sea level. 
Since most terminal area operations take place below 3048 m, the 250-knot 
speed may be considered an absolute upper bound. When the aircraft descends 
to lower altitudes and approaches the runway, the speed is reduced and flaps 
are deployed to maintain sufficient stall margin. Since at any flap setting 
it is unsafe to fly at speeds greater than the flap placard speed, the upper 
bound on the admissible speeds must be reduced so that it is consistent with 
the flap placard speed. 

The lower bound on the admissible speeds is basically a function of the 
stall speed of the aircraft at any given flap setting. The generally 
accepted lower bound on terminal area speeds is 30 percent above stall speed, 
which itself is a function of the flap setting. This lower bound is often 
increased to account for wind and gust effects. 

In addition to the above considerations concerning the minimum and maxi- 
mum admissible speeds, it is generally required that, for any flap setting. 
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the aircraft be capable of flying at a maximum speed 80 percent above the 
stall speed (for the given flap setting) without the need for configuration 
change (ref. 7). Thus, if the flap setting of an aircraft is denoted by 6 
and the stall speed at that flap setting is represented by Vs(6), then the 
speed range available to the aircraft at any flap setting without configura- 
tion change is given by 


1.3Vs(6) < V < 1.8Vs(6) (67) 

From the point of view of pilot workload, it is clearly desirable to have 
a speed profile that requires a minimum number of configuration changes. 
Furthermore, operational and economic considerations dictate that aircraft 
land as quickly as possible with a minimum of delay. This, in turn, means 
that aircraft should maintain as high a speed as is consistent with the cur- 
rent air traffic situation for as long as possible. The question therefore 
arises: what is the simplest way to specify the admissible speed ranges for 

various types of aircraft so that the above ideas are reflected in the 
resulting speed profile? One alternative could be to specify the minimum and 
maximum speeds at every, or nearly every, point along the flight path. Such 
an approach would be not only prohibitive from the point of view of computer 
storage requirements, but also totally unnecessary. Instead, the basic philos- 
ophy is adopted that if the aircraft is sufficiently far away from the final 
waypoint where generally a prespecified speed must be achieved, then the mini- 
mum admissible speed should be set to 1.3 Vs(o), while the maximum admissible 
speed should be given by the smallest of the three quantities: (a) 250 knots, 

(b) the flap placard speed Vp(o) corresponding to zero flaps, and 

(c) 1.8 Vs(o), where Vg(o) is the stall speed of the aircraft with zero flap 
setting. As the aircraft proceeds along the flight path and approaches the 
final waypoint, both the minimum and maximum speeds must be lowered gradually 
so that the desired speed at the final waypoint can be achieved without 
excessive rates of speed change (it is assumed that the proper flap setting 
is maintained during the entire flight). 

At this point, the objective is to select a small number of parameters 
which, when specified as input, could be used to generate the minimum and maxi- 
mum speeds consistent with the concepts described above. It will be shown in 
the sequel that the stall speed and the flap placard speed of the aircraft at 
zero flap setting, the maximum rate of speed change, the desired air speed at 
the final waypoint, and the magnitude and direction of the wind, along with the 
knowledge of the ground track, are sufficient to determine the admissible 
speed ranges. 

Let the desired air speed at the final waypoint be denoted by 
and let and denote the magnitude and direction of the constant wind 
field, respectively. Furthermore, let VMINi, VMAXj^, i = 1,2,...,NWP, repre- 
sent the minimum and maximum air speeds at each waypoint. More precisely, it 
is assumed that if there is a turn associated with waypoint i, then it is to 
be flown at a constant airspeed, say VAj, that satisfies the constraints: 

VMIN^ < VAj < VMAXi (68) 
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Now let c and c be two prespecified numbers satisfying the inequalities 

1.3<c<c<1.8 (69) 

and define the minimum and maximum admissible cruising airspeeds, v and v in 
the terminal area as follows: 


V = c 


V.(o) 


V = min [c * VgCo), Vp(o), 250 knots) 


(70) 


It is now possible to determine the speeds VMINj^ and VMAXj^, i = 1,2,...,NWP. 
The procedure is sequential and starts with the last waypoint. Since the air 
speed at the last waypoint is specified, the following equalities are obvious: 


** ~ '^final 


(71) 


It will be assumed throughout this analysis that 


V < V 

^final - 


(72) 


This assumption is entirely consistent with current operational procedures 


VMIN. = 
1 


VMAX. = 
1 


VMINi 

and VMAXi are computed 

as 




^ V 

if VMIN^^^ = v; or if 

VMIN.^, < V 
1+1 

and 

vmin. 

1 

> V 

vinin. 

1 

otherwise 





' V 

if VMAX.^^ = v; or if 

VMAX. < V 

1+1 

and 

vmax^ 

S V 

vmax. 

otherwise 






(73) 


(74) 


where the expressions for ymin^ and vmaxi are 

VBln. = cos -♦„)]" - 

(7 

^ + v„ cos(ip^^^ - ^^'^^)]^ - 2 • a^in * cos(i);^^^ - ip„) 


vmax 


(75) 

(76) 


Both vmini and vmaxi can be given straightforward physical interpreta- 
tion (fig. 11). Assume that the aircraft has just completed the turn ati. way- 
point i and is located at the corresponding point Q^. Then vmiiii, is the 
precise air speed from which the aircraft could decelerate, using the maximum 
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op 


Figure 11.— Meaning of vmin and vmax. 
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deceleration %ini such that the resulting air speed at the beginning of the 
next turn, that is, at point Pi+i > is exactly VMINi+^; similarly, vmax^ is 
the precise air speed from which the aircraft could decelerate, using the 
maximum deceleration amin> such that the resulting air speed at point 
is exactly YMAX^+j. The subroutine used to compute the speeds VMINj^ and 
VMAXj^ is called VRANGE and is described in the appendix. 

In order to define completely the minimum and maximum admissible speeds 
along the entire flight path, and not just at the waypoints, it is assumed 
that between any two adjacent waypoints the airspeed is constrained to the 
union of the admissible speed ranges at the two waypoints. Thus, for aircraft 
in flight from point Qj[ to point Pi+j, the air speed is limited to the 
range [min(VMINi, VMINi+^3, max(VMAXi, VMAXj|^+lj]. This point is discussed 
further when the computation of the actual speed profile is described. 


Attainable Arrival Times 

Once the minimian and maximum admissible speeds are determined, the com- 
putation of the corresponding range in the attainable times of arrival to the 
last waypoint becomes relatively straightforward. In order to compute the 
range of arrival times, it is necessary to determine the minimum and maximum 
flight times from the first to last waypoint. With no additional effort, the 
range of flight times from every waypoint to the last can be calculated. 

These numbers are useful when implementing the overall guidance scheme. 

Clearly, a flight profile at the maximum admissible speeds results in the 
minimum flight time; similarly, flight at the minimum speeds yields the maximum 
flight time (it is understood that the flight is along the previously generated 
3-b flight path). The subroutine called TRANCE is used to compute the mini- 
mum and maximum flight times. 

Let TMINi, TMAX^, i = 1,2,,..,NWP denote the minimum and maximum flight 
times, respectively, from waypoint i to the last waypoint. TMIN^ and TMAXj^ 
are computed via the subroutine called TRANS, The basic inputs required for 
TRANS are the specification of a waypoint number i, the 3-D flight-path 
parameters (actually, only the 2-D ground track parameters are needed) from 
point to point Qj|^, the minimum and maximum admissible speeds at the 

two waypoints, and a positive number p satisfying the inequalities 

0 < p < 1 (77) 

The parameter p plays an important role in the computation of flight times. 

It not only determines what the air speeds should be at the two waypoints 
involved, but it also specifies the point at which the required speed change 
should occur. In effect, p completely determines the speed profile between 
waypoints (i-1) and i once the minimum and maximum admissible speeds at the 
two waypoints are given (sketch (b)). 
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Sketch (b) . 


Let VAj^_,(p) and VAj^(p) denote the desired air speeds at waypoints (i-1) 
and i, respectively. Then VAj^^j(p) and VAj^(p) are defined in terms of p as 


VA._^(p) = VMAX._j 


p(VMAX^_^ - VMIN^_j) 


VA^Cp) = VMAXi - p(VMAXi - VMINi) 


( 78 ;) 


Note that, since VMINj < VMINi _2 and VMAXj^ S VMAX^.^, it follows that 
VAj^(p) < VAi_j(p), The ground speeds at points and are then given 

in terms of the above air speeds and the appropriate wind component. Thus, if 
VQi_i(p) and VPj^(p) denote the ground speeds at points and P^, then 


VQ._^(p) = VA._^(p) + vw cos(i|^i - 
VPj,(p) = VAi(p) + v„ cos(\l»i - t|>„) 


(79) 

(80) 


If VMINi ^ VMINi_i and/or VMAXi < VMAXi-j, then VAi(p) < VAi_j(p) and 
therefore V?i(p) < VQi_^(p). This implies that a speed reduction must occur 
somewhere between waypoints i-1 and i. Where this speed change should occur 
is again determined by the parameter p. Let Slli(p) be the distance flown 
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at the ground speed VQj_j(p), S12j^(p) the distance required to effect the 
speed change from VQj^_j(p) to VPj(p), and S22^(p) the distance flown at the 
ground speed VPjlCp] (fig. 12). Since any speed change is assumed to occur 
during straight flight, the following equality must hold 

Sll^(p) + S12^(p) + S22^(p) * (81) 


The distance S12i(p) is merely a function of the two ground speeds involved 
and is given by 


S12.(p) 


VPi^Cp) - VQ?_^(p) 
^ * ^in 


(82) 


The distance S22j^(p) is then defined in terms of p as 

S22.(p) = p • [D^ - S12.(p)] (83) 


The flight times associated with each of the above three distances can be 
calculated as 


Sll.(p) - S12i(p) - S22i(p) 

=VQ._j(p) " VQ._^(p) 


T12.(p) 


VP.(p) - VQ._^(p) 
%in 


T22.(p) 


S22.(p) 

VP.(p) 


(84) 


(85) 


( 86 ) 


In order to compute the total flight time from point to point 

it remains to determine the time T23i(p) spent in the turn from point to 

point Q;j^. A detailed discussion of the general problem of calculating the 
flight time during curved flight is quite involved (see ref. 8) . The problem 
considered here is simplified somewhat by the assumption that the air speed 
is held constant during the turn. It is shown in reference 8 that if the 
desired constant air speed during the turn Aijji (see ground track generation) 
is VAj^(p), then the duration of the turning flight, T23j(p), is given by 


T23.(p) = 


where 


2 • • SGN(Aiti 


— jtan ^ — tan^ 2 y - tan ^ 



Cj = VA^(p) + V 


w 


( 88 ) 
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along ground track 


Speed profile synthesis. 


(89) 


= [VA^^(P) “ V„2]l/2 

Note that the ground speed is generally not constant during a turn, so that 
VPi(p) and VQ^(p) are different. For the sake of flexibility and modularity, 
a separate routine, TTTURN, was written to calculate T23^(p) (see the 
appendix) . 

The minimum and maximum flight times can now be generated from any way- 
point to the last waypoint. Given any waypoint i, i * 2, 3, . . . , NWP, 
and a p satisfying inequalities (77), the corresponding flight time from 
point Qi -2 to point is denoted by Tj^(p). From the above discussion, 

Ti(p) is given by 

T^(p) = Tll^(p) + T12^(p) + T22^(p) + T23^(p) (90) 

and is an output of the subroutine TRANS. Clearly, p - 0 results in the 
maximm speed profile between the two adjacent waypoints involved, while 
p = 1 yields the minimum speed profile between the waypoints. Thus, Tj^(O) is 
the minimum flight time and 7^(1) is the maximum flight time between points 
Qi ^.2 and Q^. 

The definitions of TMIN^j^ and TMAX^ require that 

™™NWP “ ™"‘nWP “ ° 

For i < NWP, the flight times TMINi and TMAXi are computed sequentially, 
but in reverse order. Thus, subroutine TRANCE starts with i = NWP, sets 
p = 0 or 1, calls the subroutine TRANS to compute Tj^(O) or Tj^(l), and then 
generates TMINj.j^ and TMAXj^_j according to 


TMIN. 

= TMIN. 

+ T. (0) 

(92) 

1-1 

1 

1 


TMAX- 

1-1 

= TMAX. 
1 

+ T^(l) 

(93) 


Desired Speed Profile 


Once the minimum and maximum flight times from the first to the last 
waypoint are known, that is, TMIN^^ and TMAX^, a desired flight time, denoted 
by ENRTIM., from the first to the last waypoint is selected. If the aircraft 
is to achieve the desired flight time while flying along the previously 
generated 3-D flight path without violating the speed constraints, ENRTIM^ 
must satisfy the following inequalities: 

TMIN^ < ENRTIM j < TMAX^ (94) 
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Assuming that ENRTIMj is chosen such that inequalities (94) are satisfied, 
the next step is to generate a speed profile which results in a flight time 
equal to ENRTIMj^. Let such a speed profile be called the desired speed pro- 
file, with the following characteristics: 

1. The airspeed remains between the minimum and maximum admissible air 
speeds along the flight path. 

2. The rate of speed change does not exceed the acceleration/deceleration 
capabilities of the aircraft, 

3. The ground speed yields the desired flight time between the first and 
last waypoints. 

From earlier developments in this section, generating the desired speed 
profile is equivalent to finding the appropriate value for the single 
parameter p. This particular parameterization scheme of the speed profile by 
a single parameter was chosen to simplify the computations, thereby reducing 
computer storage and time requirements. In certain situations, this scheme 
may not be appropriate. Thus, it may be necessary to use two parameters, one 
to reflect the speed level between the minimum and maximum admissible speeds, 
the other to determine the points along the ground track at which speed 
changes occur. 

Conceptually, the problem of determining the appropriate p is straight- 
forward. In practice, however, an iterative procedure must be used because 
the functional relationship between p and the corresponding flight time is 
not invertible. Thus, if the flight time from the first waypoint to the last 
one corresponding to any p satisfying equation (77) is denoted by T(p), 
then the explicit expression for T(p) is 

NWP 

T(P) T^(P) (95) 

i-2 

where T^(p) are the output of the subroutine TRANS and are given by 
equation (90). Consequently, the problem of generating the desired speed pro- 
file is reduced to finding the value of p, say p, that satisfies the 
equation 


NWP 

2 T^(p) = ENRTIMj (96) 

i=2 
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Iterative Procedure to Find p 


Step 1— Let j = 1 and select the initial value of pj to be 

ENRTlMj - TMINj 
^ TMAX^ - TMINj 


( 97 ) 


Step 2— Compute T(pj) according to equation (95), namely, 

NWP 

T(P .) = T. (p ) (98) 

^ i=2 


Define ERRORj as 


ERRORj = ENRTIMj - T(p^) , 


(99) 


and let e be an arbitrary positive number specified in advance. 

Step 3— If ERRORj satisfies the stopping criterion 

1 ERROR.! < e (100) 

' r , 

then p = pj and the iterative procedure stops- If equation (100) is not 
satisfied, then Pj+i is set equal to 


p 






SAT 




ERRORj 

TMAXj - TMINj 



( 101 ) 


and steps 2 and 3 are repeated. The function SAT(*) used above is defined as 


'1 if (♦) > 1 

SAT(-) = < (•) if -1 <(•)<! 
,-l if (•) < -1 


( 102 ) 


Defining Pj+, recursively by equation (101) assures that, if T(pj) < ENRTIM^ , 
then pj + i > Pj,* if T(pj) > ENRTIM^, then pj + ^ < p j ; and if T(p j) = ENRTIM^ , 
then Pj + ;L “ Pj* Furthermore, equation (101) assures that 0 < pj + i < 1 for 
all j = 1, 2/ . . . . Although it has not been proved, it is strongly sus- 
pected that T(p) as 'given by equation (95) is a monotonic function of p. 
Consequently, the iterative procedure is expected to converge in a small num- 
ber of iterations. Computational experience indicates that this is indeed 
the case. 


Having thus found the value of p that satisfies equation (96) , it is a 
simple matter to determine the desired speed profile. The required air speeds 
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at the various waypoints are given by equations (78) , the corresponding 
ground speeds are generated by equations (79) and (80) , and the points at 
which speed changes occur are derived from equation (83) ; in all cases p is 
replaced by p. The desired speed profile is therefore completely determined. 

It will be useful to generate a sequence of NWP numbers that correspond 
to the times required to fly from the various waypoints to the last waypoint 
while tracking the 4-D flight path. More precisely, let ENRTIMj, 
i = 1, 2, . . . , NWP denote the time required to fly from the end of the 
turn associated with waypoint i, namely, Qi, to the end of the turn asso- 
ciated with waypoint NWP, namely, QnWP» while tracking the desired speed pro- 
file computed previously. From the definitions of Tj(p) and p, it follows 
that ENRTIMi can be computed by the recursive relationship; 

ENRTIM^ = ENRTIM^_j - T.(p) , i = 2, 3, , . . , NWP (103) 

where ENRTIM^ is specified as an external input. Clearly, ENRTIM^ satisfies 
the following inequalities: 

TMIN^ S ENRTIM^ S TMAX^ , i = 1, 2, . . . , NWP (104) 

All computations described in this section have been implemented in the 
form of a subroutine called SPEED. A detailed programming description of 
SPEED is given in the appendix. 


4-D GUIDANCE COMMANDS 


In order to generate the sequence of 4-D guidance commands corresponding 
to the desired ground track, altitude profile, and speed profile computed in 
the three previous sections, it is necessary to interleave the individual 
command components in chronological order. This interleaving process is 
accomplished conveniently in the subroutine SPEED immediately following the 
speed profile computations of the previous section. 

Before giving a detailed description of generating the chronological 
sequence of guidance commands, it is useful to recall the basic structure of 
each of the three components — ground track, altitude profile, and speed pro- 
file. The ground track of any flight path (as computed under Ground Track 
Synthesis) consists of a sequence of alternating straight lines and circular 
arcs (some of the turns, of course, may be degenerate). Thus, a straight-line 
flight followed by a circular turn can be considered as the basic element or 
”building-block" of the ground track. This basic element is completely 
defined by the following parameters: the x,y coordinates of the beginning of 

the straight line, the heading and length of the straight line, and the 
direction, angular extent, and radius of the turn. Given these parameters, 
the x,y coordinates of the beginning and end of the turn are uniquely deter- 
mined and can be computed easily. From the definition of the basic element. 
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it is clear that the number of basic elements in a complete ground track is 
equal to the number of waypoints. 

The altitude profile (as described under Altitude Profile;) consists of 
piecewise constant flight-path-angle segments between the beginnings of 
straight-line flights. Each segment can be considered as the basic element o± 
the altitude profile. This is particularly appropriate since, in this case, 
the basic element of the altitude profile coincides with that of the groun 
track, resulting in a simple, well-defined basic element for the 3-D lig t 
path. The parameters that define each element of the altitude profile are 
the z coordinate of the beginning of the segment and the sense and magnitude 
of the constant flight-path angle. Since the ground track is already known, 
the z coordinate at the end of the segment, as well as any other point, can 
be computed. The expression for the z coordinate of the end of the straight 
flight segment is given under Altitude Profile. 

Finally, recall from the previous section that the most general speed 
profile consists of at most four separate subsegments for each basic element 
of the 3-D flight path, that is, from the beginning of one straight line 
flight to the beginning of the next one. The first three subsegments occur 
in straight flight: the first subsegment is a constant speed flight, 

the second subsegment the speed is changed at a constant rate, and the third 
subsegment is again a constant speed flight at the new speed. The 
segment occurs during the curved flight, and the speed profile is such that a 
constant air speed is maintained during the tum.^ These four subsegments can 
be considered as the basic unit of the speed profile. A typical unit, such as 
the one just described, is shown in figure 12. Due to the particular tech- 
nique of generating the speed profile, the only parameters needed to compute 
subsegments are the minimum and maximum admissible air speeds at the 
waypoints, the direction and magnitude of the wind, and the parameter p that 
reflects how close the actual speed level is to the maximum admissible level. 

Each basic element of the 3-D flight path contains one to four basic 
elements of the speed profile. Consequently, the entire sequence of 4-D 
guidance commands is decomposed into subsequences, each of which describes 
the desired motion of the aircraft from one waypoint to the next (actually, 
by convention, a subsequence starts at the beginning of a straight flight 
segment and ends at the beginning of the next straight flight segment). 


Guidance Vectors 

It is now evident that the guidance commands are piecewise constant dur- 
ing individual guidance intervals. Let At]^ denote the duration of the kth 
guidance interval, and let the corresponding constant guidance commands ^during 
the kth interval be represented by a]^, uk, and Yk> where a^ is the rate of 
change of air speed, is the inverse of the turning radius (see equa- 
tion (11)3, and Yk is the flight-path angle. Thus, the 4-D commands for the 
kth guidance interval can be represented by a constant 4- vector, fk, of the 
form: 
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''k = t*'k' “k’ ''kl 


CIOS) 


In order to assemble the chronological sequence of guidance commands, it is 
necessary to determine the sequence of constant 4-vectors given by equa- 
tion (105). This is accomplished in the subroutine SPEED using various 
parameters of the ground track, altitude profile, and speed profile. 

Assume that the command vectors f]^ have been determined from waypoint 1 
to waypoint i-1 or, more precisely, from the beginning of the first straight- 
line segment to the end of the turn associated with waypoint i-1, that is, 
point Qi-i« Furthermore, assume that the number of nondegenerate command 
vectors for this portion of the flight path is (NCIj_j -1), where a command 
vector f],^ is said to be nondegenerate if the command interval Atj^ is 
nonzero. (Actually, from a computational point of view, fj^ is considered 
nondegenerate if Atj^ > e, where e is an arbitrarily small positive number. 
In the computer implementation of the guidance system, e is taken to be 0.1 
second.) The numbers NCIj, j = 1, 2, . . . , NWP play an important role in 
the overall guidance scheme and will be discussed later. 


Letting k = NCI^.^, the nondegenerate guidance vectors from point 
to point can now be easily determined by the following sequence of 

operations ; 

Step 1 - If Tlli(p) i e, set = [Tlli(p), 0, 0, GAMiJ , 

k = k + 1, and go to step 2; 
otherwise, go to step 2, 


Step 2 - If T12i(p) > e, set fk = [T12i(p), 0, GAMi] , 

k = k + 1, and go to step 3; 
otherwise, go to step 3, 

Step 3 - If T22j^(p) > e, set = [T22i(p), 0, 0, GAM^] , 

k = k + 1, and go to step 4; 

go to step 4, 


(106) 


otherwise. 

Step 4 - If T23i(p) > e, set 


r ^ SGN(A,/).) T 

fk = |T25i(p), 0, , GAMi , 


k - k + 1, and go to step 5; 
otherwise, go to step 5, 


Step 5 — NCIi = k. j 

From (106), it is clear that NCIi ~ < 4 and therefore the 4-D flight 

path between any two adjacent points and Qi can be described by at 

most four nondegenerate guidance vectors of the form of equation (105). 

This in turn, implies that the maximum number, MAXSEG, of nondegenerate 
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guidance vectors needed to generate a complete 4-D flight path satisfies the 
inequality 


MAXSEG < 4 • (NWP - 1) U07) 

In view of (106) , the number NCIj^ can be interpreted as a pointer in 
the following sense. Suppose that all nondegenerate guidance vectors for a 
particular 4-D flight path have been determined via the operations defined 
by (106). Then the first guidance vector immediately following waypoint i 
(actually, point Qj^) is Thus, if for some reason the only 4-D guid- 

ance vectors of interest are those starting at waypoint i, the pointer NCIj^ 
makes it possible to identify immediately the correct starting vector. For 
reasons which will become evident in the next section, the sequence {NCIj|^} is 
initialized by setting NCI^ = 5. 

Once the guidance vectors are known, they can be applied in two different 
ways for tracking the 4-D flight path. If the control surfaces of the air- 
craft are coupled to the autopilot/autothrottle, then the guidance vectors 
could be used as input to the autopilot/autothrottle, which, in turn, would 
generate the appropriate signals to drive the control surfaces and the 
throttle. This would allow one to track a 4-D flight path completely auto- 
mactically. On the other hand, the guidance vectors could be used to drive 
the flight director and other displays in the cockpit, thereby enabling the^ 
pilot to track the 4-D flight path manually. Various mixed modes of operation 
would also be feasible, for example, the throttle could be driven auto- 
matically, while the remaining tracking functions could be performed by the 
pilot. 

The two main tracking options described previously have been incorpor- 
ated in the design of an automated guidance and control system for STOL air- 
craft (ref. 5). The system has been tested extensively in the STOLAND flight 
simulator at Ames Research Center, and the manual tracking option has been 
tested in flight. 


Compensation for Finite Roll and Pitch Rates 

Throughout the present analysis, it was assumed that aircraft can make 
changes in bank angle and flight-path angle instantaneously. . This is a 
reasonable assumption for the purposes of generating 4-D flight paths that 
may be orders of magnitude longer (in time) than the time constants of the 
controls involved. However, in order to achieve very precise tracking via the 
guidance vectors described earlier, it is necessary to account, in some fash- 
ion, for the fact that both the roll and pitch rates of aircraft are finite, 

A simple yet effective means of compensating for these finite rates is by 
introducing appropriate lead times in the guidance vectors. Thus, if the roll 
ing and pitching maneuvers are initiated slightly in advance of the times dic- 
tated by the guidance vectors defined by (106), then the tracking errors can 
be minimized. It will be shown in the sequel that very simple expressions 
can be deriyed for the proper lead times, and these lead times depend only on 
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the maximiflii control signal (bank angle and flight-path angle) and the maximum 
control rates (roll and pitch rates). 


Roll-Rate Compensation 

Assume that the aircraft is flying along a straight line until at some 
instant of time, say tj, a new guidance vector is applied that requires the 
aircraft to roll to its maximum permissible bank angle 4’max’ generating 
the guidance vectors, it was assumed that the aircraft is capable of rolling 
to (f>iuax instantaneously at t,. This is clearly not true since the maximum 
roll rate of aircraft in generally limited. Denote this maximum roll rate by 
^max assume that all banking maneuvers are performed at this maximum 

rate. Thus, if the roll begins at time t^, then the bank angle, as a function 
of time, is given by 


Let t 2 be the earliest time the aircraft achieves <i>jnax’ minimum 

time required to effect a bank-angle change from 0 to 4>max 




^max 

^max 


(109) 


The specific question therefore is: at what time, t(j, should a banking 

maneuver of the form of equation (108) begin if the sequence of idealized 4-D 
guidance vectors requires an instantaneous bank-angle change from 0 to <|>inax 
at time t^? In order to transform the question into a well-defined problem, 
the following boundary condition is imposed: at the instant, t,, when 4>(t) 

(eq. (108)) achieves <f>max» ^he heading should be the same as if <t>max 
been achieved instantaneously at t^ and maintained until t 2 . These two 
bank-angle histories are shown in figure 13(a). 

Using equation (108) in equation (4) yields the following expression for 
the heading at time t^: 



Similarly, if the instantaneous bank-angle change of <i>inax were applied at 
t, and maintained until t 2 , then the reference heading, i/fj.(t„) , at time t„ 
would be 


if.y(t 2 ) = + f (tan 4>max^(t2 - t^) (111) 

Let be the lead time, that is, = (t, - to). Then equating 4'(t2) to 

V'rft^) and using equation (109) yields the following for 
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b Finite flight-path-angle rate 


Figure 13.— Compensating for finite roll and pitch rates 






T - 

^max ^max ^max 


(112) 


Since, for the most terminal area operations, 'j>max - following 

approximations are valid: 


iln(cos A ) 
^ ^max^ 


max 

2 


(113) 


tan <t>, 


max 


'max 


(114) 


and the resulting expression for is 


X 




4 > 

max 


2<l> 


max 


(115) 


(Note that the lead time given by equation (115) is equally applicable when the 
aircraft is to roll out of a turn,^that is, when the bank angle changes from 
“^max to 0.) A typical value of i^^ax ™3.y be S degrees /second, and therefore 
the lead times required for banking maneuvers may be of the order of 2 to 
3 seconds. 


Pitch-Rate Compensation 

The derivation of the appropriate lead time to compensate for finite 
pitch rate is analogous to the derivation of x^. The essential difference 
is that the boundary condition imposed on the problem is in terms of the 
altitude of the aircraft. 

Referring to figure 13(b), let the flight-path angle y(t) be given by 

« 

where Ymax is the maximum permissible pitch rate. Furthermore, let Xy be 
the lead time defined by xy = tj - to. The problem is to determine Xy 
subject to the following boundary condition: at the instant when y(t) 

(as given by eq. (116)) becomes Y 2 » altitude should be the same as if 
had been achieved instantaneously at t^ and maintained until (fig. 13(b)). 

Using equation (116) in (3) yields the following expression for the alti- 
tude at time (assuming constant speed) : 

z(t^) = z(to) + VYo • (t2 - to) + • (t^ - to)2 (117) 
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If th6 flight-path angle were changed instaTitaneously from to at 

tj and maintained until t 2 > then the reference altitude, z.j^(t 2 ), at time 
would be 

ZrCt2) = 2(t^) + VYo • (ti - to) + VY 2 • (t^ - t^) a 

* 

Equating (117) to (118) and using the fact that (tj - t^) = (Y 2 " ' 1 ^ 0 ^ '^^max* 
yields the following for 


T 


Y 



2y 


max 


( 119 ) 


In practice, the admissible maneuvers in the vertical plane are limited 
not so much by the maximum pitch rate of the aircraft, but by the vertical 
acceleration due to the pitching motion. Assuming that flight-path angle 
changes take place at constant speed, the maximum vertical acceleration, 
'^max* obtained from equation (3) by simple differentiation: 


max 


= VY 


max 


( 120 ) 


Combining equations (119) and (120) yields 


X 

Y 


V ♦ (Y2 - Yo) 

^'^max 


An accepted value of Zmax 0.68 m/sec^ (2.25 ft/sec^), so that, for 
typical terminal area speeds and flight-path angles, x^ is of the same order 
of magnitude as x^. 

Having thus obtained the lead times x^ and Xy, the timing of any 4-D 
guidance vector that requires a change in bank angle and/or flight-path angle 
is merely advanced by the appropriate lead time. Extensive simulations on the 
STOLAND flight simulator indicate that compensating for finite roll and pitch 
rates in the manner described above is more than adequate for accurate tracking 
of typical terminal area flight paths. 

A particularly convenient place to compute the lead times X(j, and xy is 
in the subroutine SPEED. Details of these computations are discussed in the 
appendix . 


CAPTURE MODE 


The aim of any 4-D guidance scheme is to guide the aircraft accurately in 
space and in time. Specifically, the aircraft is to be guided along a precise 
3-D flight path and a precise time schedule so that its arrival time to the 
last waypoint, and therefore to the runway threshold, can be predicted 
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accurately. In order to accomplish this objective, not only must the aircraft 
be guided accurately from the first waypoint to the last waypoint, but also 
from its initial position in the terminal area to the first waypoint. Essen- 
tially, a 4-D flight path must be generated from the current state of the air- 
craft to the desired final state. The major difficulty in computing such a 
flight path is the fact that the current state of the aircraft, which would 
serve as the reference point for the computation, is continuously changing. 
Thus, rather than consider the current position of the aircraft as the first 
waypoint and contend with a nonstationary reference point, the segment from 
the current aircraft position to the first waypoint is treated separately. 

This part of the flight path is referred to as the capture flight path since 
it represents the maneuvers required to capture the first waypoint. 

Two important advantages are derived from separating the capture flight 
path from the rest. First, the very complex and time-consuming computations 
needed to generate the 4-D flight path from the first to the last waypoint are 
performed usually once or, at most, a few times during the flight (the reasons 
for computing the 4-D flight path more than once are discussed later). Thus, 
valuable computer time is available for other guidance, control, and naviga- 
tion functions. Secondly, since the capture flight path is relatively simple 
and is generated rapidly, manual path stretching and time control maneuvers 
can be performed by the pilot. Such maneuvers will be shown to be important 
elements of the overall 4-D guidance scheme. 

Assume that the aircraft is at an arbitrary point in the terminal area, 
say point PA, with heading "FA and airspeed VA (fig. 14). Furthermore, 
assume that the 4-D flight path from waypoint 1 to waypoint NWP has already 
been computed. Since the capability of capturing any one of the waypoints is 
a very useful feature, the point to be captured is denoted by QB rather than 
by Qj . Note that this convention in notation anticipates the likelihood that 
the capture flight path, in general, will begin and end with a turn. Thus, 

QB may be the endpoint of the turn associated with any one of the waypoints 
(from now on, it is called the capture waypoint). The heading to be achieved 
at the capture waypoint is simply the heading of the straight-line segment 
following point QB, and is denoted by Tc. Finally, the airspeed at the 
capture waypoint is denoted by VB. Thus, the objective is to generate a 4-D 
flight path that starts at PA with a heading YA and speed VA and ends at 
point QB with heading YC and speed VB. 

The capture flight path satisfying the above end conditions is generated 
using the same basic logic used in previous sections. First, the ground track 
is computed using a straight flight segment and circular turns; then the 
altitude profile is determined and, finally, an appropriate speed profile is 
generated. 


Ground Track Computation 

Since minimum flight time is generally a desirable property of a flight 
path, the ground track is to have a minimum path length. The problem of 
computing the minimum path length ground track for arbitrary end conditions is 
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quite complex (ref. 9). It was shown in reference 9 that the most general 
ground track of minimum length subject to a turning radius constraint consists 
of either three alternating circular turns or two circular turns separated by 
a straight-line flight. Rather than the complete algorithm developed in 
reference 9, only a simplified version is used here, according to which ground 
tracks with three alternating circular turns are ruled out. This simplifica- 
tion has two significant advantages. First, the substantial computational 
requirements to check for the existence of, and the actual determination of, 
a three- turn minimum length flight path for arbitrary end conditions are 
eliminated. It is shown in reference 9 that the regions of end conditions for 
which the minimum length ground track consists of three consecutive opposite 
turns are quite small and they usually occur when the two end points are very 
close. Eliminating this type of ground track therefore reduces the computa- 
tional complexity without significantly affecting the minimum length property. 

The second advantage of not considering three-turn ground tracks is 
related to pilot workload. When the 4-D flight path is to be flown completely 
manually, the workload involved in tracking accurately a 4-D flight path con- 
sisting of three consecutive, opposite turns appears to be excessive. 

Thus the problem is reduced to finding a ground track that consists of a 
turn, followed by a straight flight, followed by another turn, such that the 
specified end conditions are met and the resulting ground track has minimum 
path length among all such ground tracks. Such a ground track for two arbi- 
trary end conditions (shown in fig. 14) is generated by the following itera- 
tive procedure. 

Iterative proeedure— Let RA be the radius of the turn beginning at 
point PA (assuming a turn at PA is required) , RB the radius of the turn 
ending at point QB (again assuming that a turn at QB is required) , and 
define 'FC ’ as 


'PC' = MOD^('PC + ir) 


( 121 ) 


Now initialize the iterative procedure by setting QAq = PA and j - 1. 

Step 1. With subroutine NEWPSI, generate the minimum path length ground 
track starting at point QB with heading 'PC* and ending at point QAj_i 
subject to the minimum turning radius RB. Under Problem Description and 
Basic Approach, it was shown that such a ground track consists of a circular 
turn of radius RB, followed by a straight-line segment to point QAj_i. 

Denote the angular extent of the resulting turn by A'PBj , the end point of the 
turn by PBj , and the heading of the straight line by 'PBj . 

Step 2. With subroutine NEWPSI, generate the minimum path-length ground 
track starting at point PA with heading 'PA and ending at point PBj sub- 
ject to the minimum turning radius RA. Again, such a ground track consists 
of a circular turn of radius RA, followed by a straight-line segment to point 
PBj . Denote the angular extent of the resulting turn by A'PAj , the end point 
of the turn by QAj , and the heading of the straight line by PBj. 
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Step 3. Define the quantity TEST by 


TEST = It - I'i'Bj - ’i'Bjl 


( 122 ) 


and let e be an arbitrarily small positive number. Then, if |TESTj > e, 
set j = j + 1 and repeat steps 1, 2, and 3; if |TESTj < e, the iterative 
procedure is considered to have converged, yielding 


A'?A = 

A4-Aj 

QA = 

QAj 

'i'B = 

fBj 

PB = 

PBj 

A'?B 

-A^Bj 


(123) 


Results of the first few iterations are shown graphically in' f j,gure;- IS for two 
arbitrary end conditions. Extensive computational experience indicates that 
the iterative procedure converges very quickly, usually after two or three 
iterations. , 


Since at the time the iterative procedure is applied, the two end condi- 
tions can be arbitrary, it is conceivable that the type of turn-straight-tum 
ground track described above may not be feasible because of the close proxim- 
ity of the end points. If this is the case, then at some stage of the itera- 
tive procedure the minimum length turn- straight ground track from either point 
QB to point QAj_i or from point PA to point PBj is not feasible. If 
this occurs, then an error message is generated by subroutine NEWPSI and 
computation stops. 


Altitude Profile 

The altitude profile for the capture flight path is assumed to consist of 
a single, constant flight-path-angle segment from the current aircraft alti- 
tude to the desired altitude at the capture waypoint. Assuming that PA is 
the current aircraft position and QB, the capture waypoint (fig. 14), the 
flight-path angle GAMB is given by 


GAME 


ZPA - 2QB 
ADA + DB + ADB 


(124) 


where ZPA and ZQB are the z coordinates of points PA and QB, respectively; 
ADA and ADB are the arclengths of turns h'Hk and AfB, respectively; and DB 
is the length of the straight flight from point QA to point PB (fig. 14). 

Note that equation (124) is the approximate expression for GAMB analogous to 
equation (64), rather than the exact expression involving the tan“l(*) 
function. Before GAMB (as given by eq. (124)) is considered acceptable, it 
must be checked to see whether it lies within the minimum and maximum 
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Figure 15.— Ground track synthesis for capture flight path. 



admissible flight-path angles. If it lies outside the allowed range, then an 
error message is generated and computation stops. 


Finally, the z coordinates of points QA and PB are determined using 
GAMB and some of the ground track parameters: 


ZQA = ZPA - ADA.* GAMB\VV-.- 
ZPB * ZQA DB ♦ GAME , 


(125) 


Figure 16 shows the altitude profile corresponding to the ground track of 
figure 14. 


Speed Profile 

For computational simplicity, the speed profile is assumed to consist of 
at most four segments. The initial turn from point PA to QA is flown at 
constant air speed VA; the second and third segments occur during the 
straight-line flight, the second one being a constant speed segment at speed 
VA and the third, a speed change segment from VA to VB at a constant rate. 
Finally, the fourth segment is a turn at constant air speed VB. Such a typi- 
cal speed profile is depicted in figure 17, which shows both the air speed and 
ground speed profiles. The expression for the ground speeds at points QA and 
PB, namely, VQA and VPB, are 


VQA - VA + ‘ cos(VB - 

VPB = VB + • cosCVB - f,^) 


(126) 


The distance SAB 
VPB is 


required to achieve the 


SAB 


VPB-^ 


VQA^ 


min 


VPB2 - VQA2 
2 • a 

max 


ground speed change from VQA to 
if VPB < VQA 

(127) 


otherwise 


Clearly, a speed profile of the structure described above is feasible only if 


SAB < DB 


(128) 


If equation (128) is not satisfied, then an error message is generated and 
computation stops. 

Finally, let Tl, T2, T3, and T4 denote the time duration of each of the 
four speed segments. Tl and T4, which correspond to the two turns, are com- 
puted by the use of subroutine TTTURN. Times T2 and T3 are given by 


53 






• _ n 


g] 



Adb 


(129) 


T2 


DB - SAB 
VQA 


T3 


' VPB - VQA 


min 


VPB - VQA 


max 


if VPB < VQA 


otherwise 


(130) 


4-D Conmiands 

The 4-D commands for the capture flight path can be assembled in a manner 
similar to those for the flight path from the first to last waypoint described 
under Four-Dimensional Guidance Commands, At most four constant guidance 
vectors are needed, one for each of the speed segments described above. Let 
the four guidance vectors be fj^, k=l, 2, 3, and 4. Letting k = 1 and 
using the same logic as in equation (106), the nondegenerate vectors f]^ are 
determined by the following sequence of operation: 


Step 1 - If T1 > e, 
otherwise. 

Step 2 - If T2 > e, 
otherwise. 


set fj. = [ti, 0, game], 

k = k + 1, and go to step 2; 

go to step 2, 

set f]^ = [T2, 0, 0, GAME], 
k » k 1, and go to step 3; 

go to step 3. 


= T3, 

— 


. 0 . 


Step 3 - If T3 > e, set 

k = k + 1, and go to step 4; 
otherwise, go to step 4. 


B , 


step 4 - If T4 ; e, set f. - [ 14 , 0, , 

k = k + 1, and go to step 5; 
otherwise, go to step 5. 


game] , 


Step 5 - NCI = k - 1. 




(131) 


In (131), e is the same small positive number as in (106), and NCI is the 
number of nondegenerate command intervals for the capture flight path. 
Clearly, NCI ^4. If TCAP denotes the time duration of the capture flight 
path, then TCAP is given by 


NCI 

TCAP = &tj^ (132) 

k=l 
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The reason for starting the indexing of the guidance vectors fi^ in the 
previous section with k = 5 should now be obvious. Letting the first four 
vectors in the sequence {f]<} refer to the capture flight path (actually, there 
are only NCI < 4 nondegenerate vectors for the capture flight path) and the 
remaining vectors fj^, k = 5, 6, . . . , MAXSEG + 4 refer to the flight path 
from the first to the last waypoint, the entire 4-D flight path can be 
characterized by the single sequence of guidance vectors {f]^^, 
k = 1, 2, . . . , NCI, 5, 6, . . . , MAXSEG + 4. This convention eliminates 
long and cumbersome recomputations of the guidance vectors that would other- 
wise be required during on-line use of the guidance system. 

The computation of the capture flight path is implemented in the form of 
a subroutine called TST whose programming details are described in the 
appendix. 


ON-LINE 4-D GUIDANCE 


The two separate parts of the 4-D flight path can now be combined to yield 
a continuous, on-line guidance scheme from an arbitrary initial aircraft 
position, velocity, and heading to any desired final position, velocity, and 
heading. Assume that the 4-D flight path from the first to the last waypoint, 
as well as the 4-D capture flight path from the current aircraft position to 
the capture waypoint, have been computed. Denote the index of the capture 
waypoint by CWP, let TABS be the current value of absolute time and TOA 
the absolute time of arrival to the last waypoint. Then, assuming that the 
aircraft begins immediate tracking of the 4-D flight path generated from its 
current state through the capture waypoint to the final waypoint, the expres- 
sion for arrival time to the last waypoint is 

TOA = TABS + TCAP + ENRTIM^^^p (133) 

Equation (133) plays a crucial role in the precise time control of 
aircraft. First, the arrival time to any specified point, such as the outer 
marker or approach gate, can be predicted by the use of equation (133) long 
before the actual arrival. Thus, if the flight paths of several aircraft 
merge at a common point, the arrival time of each aircraft to the merge point 
is accurately predicted by equation (133). Consequently, potential conflicts 
can be detected early, long before last minute collision avoidance maneuvers 
would be required. Secondly, not only can the possible arrival time be pre- 
dicted by use of equation (133), but it can also be changed in a highly con- 
trolled fashion. Once the aircraft is under 4-D control, a desired arrival 
time can be achieved in three ways; 

1. Change the initial state of the aircraft by performing arbitrary 
path-stretching maneuvers and speed changes, thereby changing TCAP. 

2, Generate a new speed profile along the 3-D flight path from the cap- 
ture waypoint to the last waypoint, thereby changing ENRTIM(-^^p. 
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3. Select a different capture waypoint, that is, a new value for CWP, 
thereby affecting both TCAP and ENRTIMj^^^p. 

The first of these is the principle method of making gross changes in the 
time of arrival. It is used primarily to delay arrival time since the 4-D 
capture flight path is already very nearly the minimum time flight path from 
the current aircraft position to the capture waypoint (unless the possibility 
of increasing the speed is considered). Thus, the arrival time can be delayed 
arbitrarily by appropriate path-stretching maneuvers. If the desired delay is 
sufficiently long, then these maneuvers generally take the form of holding 
patterns. By continuously recomputing the 4-D capture flight path from the 
current updated aircraft state to the capture waypoint, the value of TCAP is 
also updated. The attainable time of arrival from any point of the path 
stretching or holding maneuver to the last waypoint is then found simply by 
using the updated values of TABS and TCAP in equation (133) . Assuming that 
TCAP, and therefore TOA, change in a sufficiently continuous manner as the 
aircraft performs the various maneuvers, any desired arrival time could be 
achieved by initiating the tracking mode precisely at the instant TOA becomes 
the desired time of arrival. (Although questions concerning the continuity of 
TCAP have not been rigorously investigated, computational experience indi- 
cates that TCAP is a sufficiently continuous function along the usual path- 
stretching and holding maneuvers; for further discussion, see ref. 9.) 

The second method of changing the arrival time is useful when minor 
adjustments are desired. Recall that during the process of generating the 
desired speed profile it was necessary to compute the two arrays TMIN^, TMAXj^, 
i = 1, 2, . . . , NWP, which are the minimum and maximum feasible flight times 
from waypoint i to the last waypoint along the 3-D flight path. Furthermore, 
the actual flight time from each waypoint to the last one corresponding to the 
desired speed profile is also available, and is denoted by ENRTIM^j^. Since 
inequalities (104) hold for all i = 1, 2, . . . , NWP, it is clear that 
ENRTIMf’^(fp, and therefore TOA, could be increased or decreased by simply 
recomputing a new speed profile from the capture waypoint to the last waypoint. 
Denote the desired change in TOA by ATOA. Then the new desired time of 
arrival can be achieved using this second method if and only if ATOA satis- 
fies the inequalities: 

TMINc^^p - ENRTIM^^^P < ATOA < TMAX^.^^p - ENRTIM^^^p (134) 

If ATOA satisfies inequalities (134), then the new value of ENRTIMj^j^p is 
set equal to ENRTIM^^y^p + ATOA and subroutine SPEED is called to generate 
the new desired speed profile. 

Note that the application of this method to change the arrival time 
makes sense only if the aircraft is already tracking the capture flight path. 
This is necessary so that the precise effect on TOA of changing ENRTIMq^^P 
can be predicted. Otherwise, it would be difficult to separate the effects on 
TOA of changing ENRTIM^^I^p and changing TCAP. 
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The third technique of changing TOA is to select an entirely new cap- 
ture waypoint. This is perhaps the most general method of achieving a new 
arrival time. Clear lyj once a new capture wayq)oint is selected, the first 
two methods are again applicable. The significance of the third technique 
lies in the fact that, in most cases, arrival time to the last waypoint can 
be advanced substantially by capturing waypoints that are closer and closer to 
the last waypoint (closeness, in this case, is measured by distance along the 
flight path). In fact, the absolute earliest possible arrival time could be 
achieved by setting CWP = NWP, that is, selecting the last waypoint as the 
capture waypoint. This follows from the near minimum time property of the 
capture flight path. 

At this point, it seems appropriate to describe briefly the sequence of 
events that would occur as a result of using the 4-D guidance scheme presented 
here. Assume that an aircraft has just entered the terminal area and is about 
to be placed under 4-D control. .. The first step is to specify the necessary 
input parameters so that the 4-D flight path from the first to the last way- 
point can be generated. This can be achieved in several different ways. One 
possibility is for the pilot to enter the input parameters into the onboard 
computer, which would then generate the 4-D flight path — more precisely , the 
4-D guidance vectors ~ from the first to the last waypoint- Since there is 
no compelling reason to carry out this computation onboard the aircraft, 
anothor possibility is to compute the 4-D flight path from the first to the 
last waypoint in advance, perhaps even prior to takeoff, and store it in the 
onboard computer. (Actually, several alternative 4-D flight paths may be gen- 
erated and stored; in each case, however, the last waypoint is assumed to be 
the outer marker or the approach gate or some other point along the final 
approach.) Whichever method is used, it is assumed that the 4-D flight path 
from the first to the last waypoint is available prior to engaging the online 
guidance system. 

The next step is to engage the online system, which immediately generates 
the capture flight path from the current aircraft position to the first way- 
point (assuming a feasible capture flight path exists) . The two flight paths 
are then combined to form a complete 4-D flight path from current aircraft 
position to the last waypoint. Simultaneously, the would-be arrival time is 
computed and displayed to the pilot. As the aircraft continues its flight in 
the terminal area, the capture flight path and the projected arrival time are 
continuously recomputed to reflect the current initial state of the aircraft. 
At some point during the flight. Air Traffic Control specifies the desired 
arrival time for the aircraft. The pilot then initiates one of the three 
techniques described earlier to achieve the desired arrival time. When the 
would-be arrival time displayed in the cockpit coincides with that requested 
by ATC, he engages the tracking mode. Barring unforeseen circumstances, the 
aircraft then follows the 4-D flight path and reaches the last waypoint pre- 
cisely at the requested arrival time. 

It is conceivable that, at some point during the tracking mode, the air- 
craft may have to abandon the original arrival time, disengage the tracking 
mode, and attempt to meet a new arrival time. This change may be due to 
various reasons such as another aircraft given unshceduled priority to land. 
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sudden change in weather over the airport, unforeseen runway congestion, col- 
lision avoidance maneuver, etc- If the request is by ATC, then the pilot 
would disengage the tracking mode, perform the necessary maneuvers to achieve 
the new arrival time, and then re-engage the tracking mode. If the change is 
due to a collision avoidance maneuver, then the tracking mode is again disen- 
gaged (this time automatically). After the conflict has been resolved, a new 
desired arrival time is specified and the pilot attempts to meet it using one 
of the three techniques presented earlier. 

The 4-D guidance system presented here has been implemented, along with 
the necessary control law and executive functions, using the STOLAND avionics 
hardware-software package (ref. 10) at Ames Research Center. The system has 
undergone extensive testing in the STOLAND simulator, and it is currently 
awaiting actual flight tests in the CV-340 aircraft. The system is described 
further in reference 5. 


AN ILLUSTRATIVE EXAMPLE 


A simple example illustrates the ideas described here. The aircraft 
under consideration is a STOL-type aircraft subject to the following perfor- 
mance and operational constraints: 

*^max “ maximum bank angle 

'^max * m^irou® flight-path angle 

^min ” "^'S*** minimum flight-path angle 

^ax “ 0-305 m/sec^, maximum acceleration 

= -0.305 m/sec^, minimum acceleration 

Vg(0) = 45.72 m/sec, stall speed with (5 = 0" flaps 

Further, it was assumed that during flight, when the aircraft is sufficiently 
far away from the outer marker, the admissible air speed may lie anywhere 
between 1.3V^(0) and l,7Vg(0), that is, 

c = 1.3 , c = 1.7 (136) 

The geometry of the 3-D flight path is defined by six waypoints whose 
input parameters are (for this example, distances are in m, speeds in m/sec. 


and times in sec) : 
i 1 

2 

3 

4 

5 

6 

INDEX. 

1 

0 

0 

0 

1 

1 

XWP£ ^ 

2286 

7010 

7010 

-5182 

-5334 

-2438 

YWPi 

2438 

2438 

-2591 

-2591 

0 

0 

ZWPi 

-988 

-988 

-988 

-988 

-549 

-244 

Ri 

— 

1219 

1219 

— 

1295 

— 
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The desired final heading and final speed of the aircraft at the last 
waypoint are given by 


, = 0 ® 

^final 

Vfinal = 41.15 m/sec 


(137) 


Finally, it is assumed that, in this particular case, the magnitude of the 
wind is negligible so that 


= 0 m/sec 


(138) 


The first step is to generate the 3-D flight path by computing the ground 
track and then the altitude profile. This was accomplished using subroutine 
THREED. The resulting ground track is shown in figure 18, and the altitude 
profile is illustrated in figure 19. 



Figure 18.— Ground track for example problem. 
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-5334 
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YPi 

2438 

-1372 
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-2591 

0 

ZPi 

-988 

-988 

-988 

-972 

-244 


-90° 

-90° 

0 

-180° 

0 

f^i 

1219 

1219 

627 

1295 

299 

ADi 

1915 

■ 1915 

0 

4070 

0 

XQi 

7010 

5791 

-5182 

-5334 

-2438 

YQi 

1219 

-2591 

-2591 

0 

0 

ZQi 

-988 

-988 

-988 

-549 

-299 

After the 3-D flight path is completely determined, the next step is to 
compute the speed profile. This involves the computation of the admissible 
speed ranges at the waypoints with subroutine VRANGE, the attainable minimum 
and maximum flight times with subroutine TRANCE, and, finally, the computation 
of the actual speed profile corresponding to a desired time of arrival. The 
minimum and maximum admissible airspeeds at the waypoints are 


i 

1 

2 

3 

4 

5 

6 

VMINi 

59.4 ' 

59.4 

59.4 

59.1 

58.5 

41.1 

VMAXi 

77.7 

77.7 

77.7 

59.1 

58.5 

41.1 

The corresponding 
last waypoint are 

minimum 

and maximum 

flight 

times 

from each waypoint to the 

i 

1 

2 

3 

4 

5 

6 

TMINj; 

406 

336 

278 

130 

58 

0 

TMAXi 

483 

392 

316 

130 

58 

0 


At this point, a specific desired flight time must be selected from the 
first waypoint to the last waypoint. Although any number in the range C™INj, 
TMAXj) can be selected, it was decided to generate the minimum time flight 
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path. Thus, the desired flight time from the first to last waypoint was 
chosen to be TMIN^, namely, 

ENRTIM^ = TMINj = 406 sec (139) 

Having thus specified ENRIIM^, subroutine SPEED is called to generate the 
speed profile (fig. 20). As expected, the speed profile coincides with the 
maximum admissible speed at every point since the minimum flight time was 
desired. The minimum admissible speed profile is also shown in figure 20 for 
comparison. 

The next step in the guidance algorithm is to assemble the various guid- 
ance commands in chronological order and to form the 4-D guidance vectors. 

This task is accomplished by subroutine SPEED, resulting in the following 
chronological sequence of nondegenerate 4-D guidance vectors: 


k 

Atk 


Uk 

^k 

5 

45.1 

0 

0 

0 

6 

24.6 

0 

-1/1219 

0 

7 

33.3 

0 

0 

0 

8 

24.6 

0 

-1/1219 

0 

9 

87.5 

0 

0 

0 

10 

61.0 

-.305 

0 

0 

11 

0.6 

0 

0 

-6.0 

12 

2.0 

-.305 

0 

-6.0 

13 

69.5 

0 

-1/1295 

-6.0 

14 

0.9 

0 

0 

-6.0 

15 

57.0 

-.305 

0 

-6.0 


The corresponding values of NCIj^ are 

i 1 2 3 4 5 6 

NCIi 5 7 9 11 14 16 

The lead times X(j) and t-y are also computed in subroutine SPEED. Since 
the ground speed, and therefore the bank angle, may be different at the 
beginning of a turn from that at the end of the turn, each turn requires the 
computation of two lead times. For the specific example under consideration, 
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Distonce along ground track 


Figure 20.- Speed profile for example problem. 




however, the wind was assumed to be negligible, so the ground speed, and 
therefore the bank angle, remain constant during a turn. Consequently, the 
same lead time applies to both the beginning and end of a turn. The values of 
the lead times for this example are 


i 

2 

3 

4 

5 

6 

"♦i 

2.7 

2.7 

3.0 

1.5 

3.0 


0 

0 

4.5 

0 

3.2 


This completes the computation of the 4-D flight path from the first to the 
last waypoint. 

In order to illustrate the computation of the 4-D capture flight path, 
the following initial conditions are assumed for the aircraft: 


Xac = -1524 
Yac = 4572 

Zac = 

^AC = 0“ 

^AC =83.8 m/sec 


aircraft position 

aircraft heading 
aircraft airspeed 


\ 


/ 


(140) 


Assuming that the first waypoint is the capture waypoint, that is, CWP = 
subroutine TST is called to generate the capture flight path. Using the 
notation of figure 14, the 3-D parameters of the capture flight path are 


XPA 


-1524 

YQA 


4352 

AYB 


34.6 

YPA 


4572 

ZQA 

= 

-674 

RB 

= 

1067 

ZPA 


-610 

GAME 


4.9® 

ADB 


645 

'I'A 


0 


= 

-34.6® 

XQB 

= 

2286 

ATA 


-54.6® 

DB 


3036 

YQB 

r: 

2438 

RA 


1241 

XPB 


1680 

ZQB 

= 

-988 

ADA 

= 

750 

YPB 

= 

2627 




XQA 


-819 

ZPB 


-933 





/ 


1 , 


(141) 
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The speed profile along the capture flight path was then computed by TST, 
and the 4-D guidance commands were assembled into the following nondegenerate 
4-D guidance vectors: 


k 

At|^ 

^k 


Yk 

1 

8.9 

0 

-1/1241 

4.9' 

2 

17.0 

0 

0 

4.9 

3 

20.0 

-0.305 

0 

4.9 

4 

8.3 

0 

1/1067 

4,9 


Assuming that no lead time is introduced for the first turn of the capture^ 
flight path, the lead times for the capture waypoint — in this case, the first 
waypoint — were found to be = 3.0 sec and Xy^ = 4.8 sec. 


CONCLUSIONS 


This report presented the detailed theoretical development and computer 
implementation of three main guidance algorithms for an experimental 4-D 
guidance system. Using a small number of input parameters, the three 
algorithms generate the ground track, altitude profile, and speed profile of 
the 4-D reference flight path, respectively. At every stage of the computa- 
tions, special care is exercised to assure that the final 4-D flight path is 
feasible from the point of view of aircraft maneuverability and structural 
limitations, terminal area operational constraints, and passenger comfort. 

The flexibility of the algorithms is reflected in the various options that 
can be provided to the pilot for purposes of controlling the time of arrival: 
any combination of manual path stretching, speed profile recomputation, and 
the arbitrary selection of the capture waypoint may be used to control the 
arrival time of the aircraft. Furthermore, the method of representing the 
4-D flight paths, namely, by sequences of guidance vectors, is particularly 
well suited for automatic or manual tracking. 


Ames Research Center 

National Aeronatuics and Space Administration 

Moffett Field, Calif., 94035, October 8, 1974 
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APPENDIX 


The Appendix describes the programming details of all routines used in 
the computer implementation of the 4-D guidance system. These routines are: 

Main executive routine: FOURD 

Subroutines: THREED, ROUND, NEWPSI, 

VRANGE, TRANCE, SPEED, 

TTTURN, TRANS, and TST 

External functions; PIMOD and SGN 

For each program, a statement of the required function to be performed 
is given, followed by a brief description of the computational method. All 
input, output, and temporary variables are defined. A list of numerical con- 
stants used in each program is also included. Finally, the subroutines called 
by each program, as well as the name of the calling program, are listed. 

In order to make the appendix a self-contained programming reference for 
the 4-D guidance system, a flow chart and source listing for each program are 
also included. Finally, the printed output of a typical computer run is 
given. 


FOURD 


Required function: 

FOURD is the main executive routine used to compute a complete 4-D 
flight path. 

Method: 

Numerical values for the required input variables are read from punched 
cards and are printed out for visual inspection. Constants and often-used 
variables are defined and polar variables are converted from degrees to 
radians. Then the subroutine THREED is called, which generates the 3-D flight 
path between the first and last waypoints. Next the routine VRANGE is called 
to compute the admissible speed ranges along the 3-D flight path; then TRANCE 
is executed to determine the corresponding minimum and maximum feasible time 
ranges from each waypoint to the last one (in order to enable the program to 
be used on-line in an interactive manner, the index of the first waypoint to 
be captured is defined as a variable and is denoted by CURWPT; given a set of 
waypoints i = 1, 2, . . . , NWP and an integer value for CURWPT, 

1 < CURWPT < NWP, the program will generate a 4-D flight path from the way- 
point whose index is CURWPT to the last one, i.e., urhose index is NWP). 
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At this point, a desired flight time, denoted in the program by 
ENRTIM(3 ^jj^j^Pj, is required from the capture waypoint to the last waypoint. 

This time can be any number in the range (TMINcurwPT> TMA^CURWPT^ * 
present version of the program, TMINcuRWpp was chosen arbitrarily. Calling 
the subroutine SPEED generates the corresponding feasible speed profile. 

Thus, the 4-D flight path is computed. Polar variables are converted from 
radians to degrees and the flight-path parameters are printed out. 

The remaining portion of FOURD (starting with internal statement number 
9500) is used as an executive routine to generate the capture flight path 
via subroutine TST. The input set needed for this part of the program con- 
sists of the position, heading, and speed of the aircraft, as well as the 
index of the waypoint to be captured (CURWPT) . This input is read from 
cards, printed out, and then subroutine TST is called. The parameters of 
the resulting 4-D capture flight path are printed. 

Input data: 

MAXPHI maximum admissible bank angle, deg 

MAXGAM maximum admissible flight-path angle, deg 

MINGAM minimum admissible flight-path angle, deg 

MAXACC maximum admissible acceleration (positive), ft/sec^ 

2 

MAXDEC maximum admissible deceleration (negative), ft/sec 

PH I DOT maximum admissible roll rate, deg/ sec 

VSNF stall speed of aircraft with zero flaps, ft/sec 

VSFF stall speed of aircraft with full flaps, ft/sec 

CUPPER ratio of maximum admissible cruising airspeed in terminal 

area to zero-flap stall speed (same as c in eqs. 

(69) and (70)) 

CLOWER ratio of minimum admissible cruising speed in terminal area 

to zero-flap stall speed (same as £ in eqs. (69) and (70)) 

NWP number of waypoints used to define flight path 

HFINAL desired heading at the last waypoint, deg 

GFINAL desired flight-path angle at the last waypoint, deg 

VFINAL desired airspeed at the last waypoint, ft/sec 

HW estimated wind direction, deg 

VW estimated wind magnitude, ft/sec 
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INDEX- waypoint-type indicator; INDEXj^ s 0 waypoint i is 

^ ordinary waypoint; INDEXi = 1 ^waypoint i is final 

heading waypoint 

XW?i, YWPi, Cartesian coordinates of waypoint i, ft 
ZWPi 

desired turning radius at waypoint i, ft; if Ri is 
unspecified (i.e., Rj^ = 0.)» then Rj^ is set equal to 
the minimum feasible radius 

Output data: 

See the output from subroutines lliREED, VRANGE, TRANGE, and SPEED, 
Temporary variables: 

CURWPl index of waypoint following the capture waypoint (=CURWPT^■1) 

NWPl =NWP+1 

GTANFI ‘=G*TAN(MAXPHI) 

Constants ; 

PI = 3.141S9 

TWOPI = 6.28319 

G acceleration due to gravity, 32,172 ft/sec^ 

RADDEG radians-degrees conversion factor, 57.2958 deg/rad 

Subroutines required: 

THREED generates 3-D flight-path parameters 

VRANGE computes minimum and maximum feasible airspeeds at each 

waypoint 

TRANGE computes minimum and maximum attainable flight times from 

each waypoint to the last waypoint 

SPEED generates the sequence of 4-D command sequence 

TST generates the 4-D capture flight path from initial aircraft 

state to the capture waypoint 
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* For variables contained in LIST I ... LIST 13, see page following this flow diogram 
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LIST1,LIST2, . . . ,LIST13 contain the following variables: 

LISTl: MAXPHI,MAXGAM,MINGAM,MAXACC,MAXDEC,PHID0T,VSNF,VSFF, CUPPER, 

GLOWER 

L IST2 : NWP , HFINAL , GFINAL , VF INAL , VW, HW 

LIST3: INDEXi,XWPi,YWPi,ZWPi,Ri,i=*CURWPT,CURWPT+l, . . . ,NWP 

LIST4: Hi,GAM^,Di,XPj^,YPi,ZPi,TURNi,Ri,DELDi,XQi,YQi,ZQi; 

i*CURWPT+l,CURWPT+2, . . . ,NWP 

LISTS: VMINi,VMAXi; i=CURWPT,CURWPT+l, . . . ,NWP 

LIST6: TMINi.TMAXi; i=CURWPT,CURWPT+l, . . . ,NWP 

LIST7: VA^, ENRTIMi,CRCDi; i=CURWPT,CURWPT+l, . , . ,NWP 

LISTS: TIMREF]^,TRNREF]^,GAMREFjf,ACCREFj^; ^"*^^^^CURWPT’ 

CRCD^yp^p'j'+l , ... jMAXSEG 

LIST9: TLEADTj^,TLEADSj_,TLEADPj,; i=CURWPT+l,CURWPT+2 , . . . ,NWP 

LISTIO: XAC,YAC,ZAC,HAC,VAC,CURWPT 

LISTl 1 : HAC , GAMWP , DAC , XAC , YAC , ZAC , TURNAC , RAC , DELDAC , XQAC , YQAC , ZQAC , 

HWP , GAMWP , DWP , XPWP , YPWP , ZPWP , TURNWP , RWP , DELDWP , XQWP , YQWP , 2QWP 

LIST12: TIMREFi^,TRNREF^,GAMREFi^,ACCREFj(.; k=l,2, , . . ,CAPSEG 

LIST13: TLEADT^,TLEADSj,TLEADP^ 
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COMMON P I T wOP I, G, R AODES, GT ANF I, NWP, HF 1 N AL » GF I NAL,VF Inal, HW,VW, 
IMAXPHI ,MAX6AH,MINGAM,MAXACC,MAXDEC,PHI00T, VSNF , VSFF , VUPPEK , 
2VL0wEfi,CURi»lPT,CU«»iPl ,NWP1 TI , XAC , VAC , ZAC , MAC , VAC , MAXSEG, 

iCAPSEG.OACi 1URNAC,RAC,DELt)AC,XQAC, YQAC,ZOAC,MRP,CAM-iP,Dt»iP, XPwP, 
aVPwP.ZPwP, TuRNWP,RwP,DELDrtP,XuMP, YOWP,ZQMP, INOEX (20) ,XWPC20) , 
5YrtP{20),ZwP(20),R(20),H(2n,GAM(2i)#O(20),XP(20),vP(20),ZP(20)f 
bTURNt20),DELD(20),XO(20), YO(20),2Q(20),VMIN(20), VMAX(20), VA{2(3), 
7VP(20), VQ{20),OVW(2n ,THIN(20J ,TMAX(20) ,FNHT1M(20) ,CRCO(20) , 
8TIIU20),TU2(20),TI22(20), rl23(20),TU,Tl2,T22,T23,TIMR£F(80), 
9TRNREF(B0),6AMSfcF(80),ACCREF (80) , T Lfc A DT ( 20 ) , TIE AOS ( 20 ) , TL t AOP ( 20 ) 
REAL MAXPHI ,MAXGAM,MIn 6AM,MAXACC,MAXO£C 
INTEGER CuRwPTi CURWPl ,CAPSEG,CRL0 
CURmPT« 1 
CHCO(CU«MpT)«b 

READ (S, 1) MAXPHI,MAXGAM,MIN6AM,MAXACC,MAX0EC,PHID0T, 

I VSNFfVSFF, CUPPER, CLOSER 

1 FORMAT(6F10.1/«FIO. 1) 

READ (5,2) NRP, HF I NAL,GF I NAL,VF I NAL,HW,Vw 

2 FORMAT(110,5F10,1) 

RE AO (5, 3) (INOEX(l),XwP(I), YRP(I) ,ZNP(I) ,«(I) , l5CU«wPT,NRP) 

3 FaRMAT{I10,aFl0,l) 

WRITE (8, R) MAXPmI ,maXGAM,MINGAM,MaXACC,«AXDEC rPHlOUT, 

1VSNF,VSFF, CUPPER, CLOWER 

a FORMAT(///2 x, 'MAXPHI «» ,F8.l/2x, 'MAXGAM »t ,F6. 1/?X, »HINGAM at, 
IF6.1/2X, 'MAXACC s' ,F6.1/2X, 'MAXOtC s ' ,Ffc , 1 / 2 X , « PHIOOT al,F 6 . 1 / 
22X,iVSNF St ,Ffc,l/2X, tVSFF * ' , F 6, 1 /2x , i CUPPEK si,F 6,1/2X, 
3'CLOWER st,F6.n 

WRI TE (8, 5) NinP.HFINAL, GF INAL, VF INAL ,Hw, VW 

S F0RMAT(///2X, »NWP si,I«,5X, tRFlNAL s i , F 6 . 1 , 5X , » GF I N AL s»,F8.l, 
15X,»VFINAL s’,F8,I,5X,»Hw s»,F8,l,5x,»Vt« si,f8,1) 

«RITE(8,8) 

8 FORMAT (///2x, ' INOEX(I) ' ,RX, ' XwP(I) » ,ax, ' YwP(l ) ' ,«X, • ZwP(I ) • ,8X, 
I'Rd)*/) 

WRITE (6, 3) (lNO£X(I),XWP(I) , Y«P ( I ) , ZWP ( I ) , R (I ) , IsCURwPT , NwP) 

Pls3.iai59 

TwOPIb8, 28319 

GB32.172 

RADDEOs57,2958 

CURhPIbCURWpTf I 

NwPlsNWP+l 

H«aHW/RADOEG 

M(NmPl ) aHF I nAL/RAODEG 

Gam{Nkipi)8GFInal/raD0EG 

MAXGAMbMAxGAM/RADDEG 

MINGAMbMINGAM/RAODEG 
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11 

12 


13 

U 

15 

16 
17 
16 
19 


21 

22 


23 

31 

32 


MaXPHI3«AXPhI/RA0DE(» 


6T4NFI*G*TAN(MAXPHI) 

PH I UO T = PH I DOT / R A OOEG 
VUPPER«CUPPER*VSNF 
VkOrtER»CLOHEP*V&NF 
CAU THSEED(ilOO) 

CALL VRANGE 
CAUL TRANGE 

ENRnMCCURrtPnsTHlNCCuR'^PT) 


CALL SPEED 

,00 11 IsCURwPl d Nwp 
H(n»H(I)*RAOOEG 
TURN ( 1 ) aTURN( n *RAODEG 
GAM( nsGAM( I ) ««A00EG 


I2i 

F0RMAT(///8X,'H(I)'»9x»'6AM<I)',6X»'D(l)'f5X,*XP(n'*5Xi'VPC I ) 

15X, f ZP(n • »3X, • TURNcn « d6X, »H(I ) ' »3X, »D£LO tl ) ' » 5 X , ’ XQ ( 1 ) » / 5X , 


RITE(6,13i fH(J)^GAM{I)dO(I)dXP(ndXP(n,ZP{n»TuRN(ndH(I), 

Euo(i)#xQ(n ,YQtn .ZQ(n»i«cuRwPi»Nwp) 

ORMAT (2Xd2FlO,2» lOp 10 , 1 3 
PITE(6, 1«) 

RMATC///2X, * VHlna) 1 , lOX, ‘ VMAXU) ' “ 

ITE(6d 15) f VHlN(I),VMAXn),I»CURwP' 

HMAT f 3X " ■■ ‘ ‘ 


I.. Cl \ 


HHlTECGdlb) 

F0RMAT(///2X. ’TMiNfl) ' flOXd »ThAXU) '/) 

WRITE (6» 17) (TMIN(I).THAX(ndI»CURWPtdNwP) 
F0RMA7(2XdFb.UllX»F6,l) 

W«ITE(6*ie) ^ ^ ^ 

format (///2X. ivA(ni,10x»»ENHTlM(I)'»lOx,'CRCt;(l)'/) 

write (6» 19) (yA(I) .ENRTlMd) fCMCDd) ,13 CURWPT,NwP) 

F0RMAT(2X»F5«1»10x,f7,1»ISX,I2) 

U»CSCD(CUkwPT) 

00 21 KaL^MAXSEG 

GAMR£F(KJ sGAMREF (K) *PAU0EG 


WRITE(6,22) . 

F0RMAT(///9X»'TIMREF(K)'d4X|»TRNREF(K)'*7Xd*6AMREF(K)‘d^X, 

1 tACQRtF(K) ^ /) 

write (6,23) (TIHREF(K),TRnHEF(K),GAMREF(K),4CCREF(K) ,K8L,MAXSEG) 

format (2X, «F 1«, I ) 

FORMAT {//I OX, iTLEaDT(I) • , 5X, ' TLtAOStn ' ,5 X, 'TlEaDP(I) »/) 
white (6, 32) (TLEAOTCI 3 .TLEAOSd) ,TLtAOPa). I*CURWP1 ,NWP) 

F0RMAT(2X,3Fia,l) 
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DO laCLM^wPt rNMP 
H(nsH(I)/RAOOeG 
TUKNC IJ«TU«N (I) /RAODtG 
ZU GAMU )sG4M(I )/R40D£G 

REAOtSWS) XAC. yAC,ZAC,MAC, VAC»CURWPT 

25 FORMAT(5PlO,l,IiO) 

MRITE(6,26} 

26 F0HMAT(///7X,'XAC',7X,'YAC'»7X.>ZAC»»7X,»HAC‘,7*»*VAC,6X, »CUR>«*PTi 
1/) 

WRITE (6 » 25) XAC, VAC,ZAC,HAC,VACfCU»rNPT 

CURwPIbCU«WPT+1 

HAC*HAC/PA00EG 

CALL TSTt&lOO) 

hac»hac*raodeg 

TuRNAC*TURNAC*RAOOEG 

H«||PsHmP*RAOOEG 

TURNmPsTURNmPaRAOOEG 

GAMwPsGAHrP*RADDE& 

DACsO , 
w«ITE(6,27) 

27 F0RMA7(///U*«'M*,7X»'5AW»,9x,>D»,ex,»XP*,8x,*YP*,ex»'ZP’fPX, 

1 ' TURN* ,9X, *R* ,6X, ‘OtUD' ,8X, ' XO * / 8X , * YQ ' , 8X » ' ZU ’ / ) 

WRITE (6, 26) HAC,GA«WP,0AC,XAC, YAC,ZAC,TUHNAC,RAC,DtLDAC,XQAC,YOAC, 
IZQACfMWP, SAMt^P* D*»Pi XPwP, YpwPi ZPt»P, TUPnWP ,RWp,0£LDwP,XaoiP, YQinP, ZUWP 
26 F0RMAT(2X, 12F16.1 ) 

DO 29 K«l,CAPSEG 

29 ttAMR£F(K)«GAMR£F(K)4cRA00EG 

WRITE(6,22) 

WRITE (6»2i) (TlMREF(K) ,TRNReF(K),GAM«eF(K) ,ACCPfcF{K) ,K*1 .CAPSEG) 
wRITE(6,3n 

WRITE (6/ 32) TLEADT(n,TLEAOSa)»TLEADPn) 

100 CONTINUE 
STOP 
END 






fry 
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THREED 


Required function: 

Using waypoint input parameters and aircraft performance constraints, 
THREED computes the 3-D flight-path parameters. 


Method: 

Beginning with the last waypoint, the minimum turning radius is computed 
and compared to the specified turning radius (if the radius is not specified, 
it is set equal, to the minimum turning radius). If the specified rd 
smaller than the minimum feasible one, a diagnostic message is printed and 
control is returned to the luain executive routine FOURD- 

Next, the type of waypoint under consideration is detemined 
the value of INDEXi. For ordinary waypoints (INDEXi-0) , subroutine ROUND 
called; for final heading waypoints (INDEXi=l), NEWPSI is called, ^his step 
yields the ground track between the waypoint under consideration and the 
preceding one. Then an upper bound on the ground speed at the previous way- 
point is computed, and the above process is repeated sequentially for all 
but the capture waypoint. 

When the complete ground track is known, the altitude at the end of the 
turn associated with each .waypoint is set equal to the prespecified waypoint 
altitude and the constant flight-path-angle segments between adjacent way - 
points are determined. Each flight-path-angle segment is chec e 
that the minimum and maximum flight-path-angle constraints are no vio 
If any one of the flight-path-angles is outside the admissible range, a 
diagnostic message is printed and control is returned to FOURD. 


Input data: 


NWP 

VFINAL 

VW 

INDEXi 

XWPi,YWPi 

ZWPi 

GTANFI 

CURWPT 

CURWPl 


number of waypoints used to define flight path 
desired airspeed at the last waypoint, ft/sec 
estimated wind magnitude, ft/sec 

waypoint type indicator (see input data for FOURD) 
Cartesian waypoint coordinates, ft 


=G*TAN (MAXPHI) 


index of capture waypoint 

ORIGINAL PAGl li 
OF POOR QUALI# 


=CURWPT+1 
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MAXGAM 


maximum admissible flight-path angle, radian 
MINGAM minimum admissible fligh-path angle, radian 

MAXDEC maximum admissible deceleration (negative) , ft/sec^ 

VUPPER maximum admissible cruising airspeed in terminal area, ft/sec 
Output data: 

heading of straight flight from point Q^.i to point Pj^, 
radian 

GAMj^ flight-path angle from point Qi_i to point Qj^, radian 

Di length of straight flight from point to point P^, ft 

XPi,YPi, x,y,z- coordinates of beginning of turn at waypoint i, ft 

ZPi 

TURNj^ angular extent of turn at waypoint i; TURNj^ > 0 right turn, 

TURNi < 0 left turn; radian 

Rj^ turning radius at waypoint i, ft 

DELDj^ arclength of TURNj^, ft 

XQi,YQi, x,y, z- coordinates of end of turn at waypoint i, ft 

ZQi 

Temporary variables; 

VGMAX maximum possible ground speed at waypoint to be processed, 

£t/sec 

RMIN minimum admissible turning radius at waypoint to be processed, 

ft 

HIl reverse of heading at final heading waypoints; 

HIl=mod_^(Hi+^+7r) , radian 

HI reverse of heading radian 

Constants : 

GTANFI =G*TAN(MAXPHI) 

PI =3.14159 
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Subroutine required: 

NEWPSI computes ground track between waypoints (i-1) and i when 
waypoint i is a final heading type (i.e. , INDEXj^-1) 

ROUND computes ground track between waypoints (i-1), i, and Ci+1) 

when waypoint i is an ordinary type (i.e., INDEX j^-0) 

Called by: FOURD 
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RMIN = VGMAX^/GTANFl 


Rj = miH 


0 < Rf < RMIN 


/ WRITE: 
J"Ri TOO 
/small" j 

RMIN=_/ 


INDEX: 


RETURN! 




XQ| 

-XWPi 

YQi 

= YWPj 

HII 

= PIMOO(Hi+i + PI) 

XI 

II 

X 

o 

Yl 

II 

X 

p 

HI 

= HIi 

Rl 

= Ri 

X2 

= XWPi_, 

Y2 

= YWPi_| 


NEWPSI 


TURN| = -TURNl 
OELDj ^ DELDI 
XP| = XOl 
YPj -YQI 

Hi - PIMOD(H2+PI) 


XI = 

XWPiH 

Yl = 

YWP|_ 

X2 = 

XWP| 

Y2 = 

YWP| 

X3 = 

XPi+i 

Y3- 

YPi + i 

R2 = 

Ri 


ROUND 


XPi = XP2 
YPi = YP2 
XO; = XQ2 
YQj = Y02 
TURNj = TURN2 
DELDi = DELD2 
Dj + i = D3 
Hi ^ H2 


^i<CURWPI i>CURWPl 

AW <j:CURWPi> W B 





















SUBROUTINE ThkEEOC*) 

COMMON PI,Tw0PI,G,RA0DEG,6TANFI,NwP»HFINAL»GFINAL, V f lNAL,Hw,Vw, 
lMA)(PHi,MAXGAM,MINGAM,MAXACC»MAXOEC»PHlOOTfVSNF#VSFF,VUPP£K# 
2VL0 *^EH»CURhPT,CUR-PWNwP1 ,I,R0,TI, XAC,VAC»ZAC,MaC»VAC,HAXSEG, 
SCAPSEG»OAC,TURNAC,«AC,DeLt)AC#XOAC, VOAC,ZQAC,HwP,GAM^P,0'nP,XPwP, 
4YPWP,ZP»jP,TURNWP,PwP»OELDwP»XQWP»YOwP,ZGwPi1NOExC^O)#XwP(ZO), 
SYNPcaO) » ZWP(20) .4(20) »H(2U »GAM(21) r0(20) ,XPt20 ) , yP(20) *ZP(20) , 
6TU«N(20),UELO(20).XQ(20),yO( 20).ZO(20),VHIN(20),VMAX(20),VA(203, 
7YP(20), V0(20) ,0VW(2n .TMIN(20) .TMAX(20) ,FN«TIM(20) ,CRCD(20), 
8TmC20),TI12(20).Tl22(20).Tr23(20),Tll,Tl2,T22,T23,TIMH£F(60), 
9TKN«EF(»0) ,GAMH£Fc80).ACC«EF(e0),TLtADT(20).TLEAOS(20),TLEAOP(20) 
REAL maxPh1,maxg4m,minGam,maxaCC»maxDEC 
integer CuRwPT.CURNPl ,CAPSEG.CRCD 
I*NhP 

VGMAXsVF INAL+VW 

10 RMINsvGMAX*VGMAX/GTANFI 
IF(R(I),GT.O,) GO TO 20 
R ( DsRMlN 
GO TO 30 

20 IF(Rm,GE.«MIN) GO TO 30 

t^RlTt(fe,21) I.PMIN 

21 F0RMAT(///2X, »p( I , 12, ' ) TOO SMALL. RmIN s '.pfl.l) 

GO TO 100 

50 IF (iNoexd) ,EQ,0) GO TO «0 
XQCDsXWPd ) 

YOd)«VRPd) 

HllBPlMOO(Md*l)+PI) 

call N£wPSI{XQ(n.YO(I),Hll,Hd),XwPCI-l). YwPd-l),TuRNd), 

I oELOcn.xPd), YPcn.Hi.uoo) 

TUHNd Js.TURNd) 

Hd )aPIMOO(Hl+RI ) 

60 TO SO 

4 0 CALL KOUNO(XWP (I - 1 ) . Y»iP ( I - 1 ) , XWP ( I) , YK(P ( 1 ) , XP ( I ♦ 1 ) , YP ( I * I ) , H (1 ) , 
lXPd),YPd),XUd).VUd).TuRNd),OELOf I).D(Itn.Md).RlOO) 

50 IF d .LE.CURwPl) GO TO 60 
Isl«l 

IF (VGMAX.GE. YUPPtW+Vw) GO TO 10 

VGMAXaSQRT ( V&MA X * VGM AX *2 , *M A XOEC *SORT dXP(I + l ) -XwP ( I ) ) **2 + 

1 (YPd + l)-VwPd))*A2) ) 

IF ( VGMaX.GE. VUPPe« + V»- ) VGMAXsVUPPER + VW 
GO TO 10 

60 XO(CUHWPT)»XWP(CURWPT) 
yg(CUHWpT)*YwP(CURRPT) 

ZU(CURwPT)sZWP(CURt^PT) 

00 70 IsCUPwPl.NWp 


P^QEI TO 

Poor quautv 


82 



D(nsSQ»Tn'^p(n-^un'=’n)**2+(vp(n-T'«(i-u)**^) 

^QCnsZwPci) 

G&HtijsczQd^n-zfKnwfocn+oeuod) ) 

IF (GAM c n ,ut &ND*GA m( I) ,G£.mInGAM 5 GO TO 70 
ivRIT£(6,6n I 

61 FOPMAT(///?X, *GAM,-iA OUTSIDE RAMGf i.ItO) 

GO TO too 

70 ZPa)a29(I^n'=-Df n*GAM(I) 

HtTUftN 

joo return i 

End 







ROUND 


Required function: 

This routine is used to compute the ground track parameters of a flight 
path defined by three points in the following manner, the ground track 
begins at one of the points with a straight line directed toward the second 
point; near the second point, a circular turn of a given radius is made such 
that the resulting new heading is directly toward the third point. 

Method; 

The headings of the straight lines from the first point to the second 
point and from the second point to the third point are first computed. From 
their relationship, the magnitude and direction of the required turn are 
determined. It is then checked whether the three points are sufficiently 
far apart so that the turn computed above is in fact feasible. If either 
end point is too close to the middle point, a diagnostic message is printed 
and control is returned to the calling program (in this case, THREED). If 
the turn is feasible, then the arclength and the x,y-coordinates of the 
beginning and end of the turn are computed. 

Input data: 

XI, Y1 

X2,Y2 

X3,Y3 

R2 

Output data: 

H2 


H3 


TURN2 


D2 


D3 

DELD2 


x,y- coordinates of first point, ft 
x,y- coordinates of second point, ft 
x,y- coordinates of third point, ft 
turning ra4ius at second point, ft 

heading of straight line from first point to second point, 
radian 

heading of straight line from second point to third point, 
radian 

angular extent of turn near second point, raciian 
(note: |tURN2|<it) 

length of straight line from first point to point where 
turn begins, ft 

length of straight line from end of turn to third point, ft 
arclength of TURN2, ft 
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XP2,YP2 x,y- coordinates of beginning of turn, ft 

XQ2,YQ2 x,y- coordinates of end of turn, ft 

Temporary variables: 


SIGN 

reflects direction of TURN2; SIGN-+1 ^ 
TURN2>0, SIGN=-1 => TURN2<0 

SIDE 

distance between beginning (end) of turn and second 
point , ft 

Constants: 


PI 

=3.14159 

TWOPI 

=6.28319 


Subroutine required: None 

Called by: THREED 















suPwouTiNt KOu^u(xt# VI * 
iUtLU<?,D5,H?,*) 

?i*i, iai'39 

T^OPI = fe,2ii5iq 

rti = ATAN<?(Y2-yi,A<i-Vn 

Hjs.4TA^£;(y J-V2, 

SlGNsBriiMC (Vi«Y?)*COS{rt2)-(X-i-A?)*SlN(M2) ) 

r? C SiGW.tT ,0, ) GO TU 1 
If' fH3,LI ,h 2) H3 = Hi + TwOPI 
GU TQ ? 

1 IP(hi,GT,H2) H3=H3-TwuPi 

2 tUPN«iSN3»M2 

SIDt = P2*TaN,(4bSnuPN2)''<?.) 

02s3Q*YT[(*2-xn*(x?-vn*(V2-Yn*(t2«vn)»5IUt 
U fU2,Gt,u, ) GO TO 3 
wPnt(b,10) *2,V2 

10 F0k^'4T(///2X, •vmAyPUI.'vTS too CLUSt ' //F ?0 , I /F?0 , H 

GO TU b 

3 03sSGwT( ( <3-V^)*(h 3-X2T + (Y3-V21*(Y3-V^1 ).>bIQf 

■ If (Ui.Gt.i'. ) G'T TO a ' • 

'*<91Tt(b,10) x3,Vi 
GO TU b 

u D£Lu2 = «2*aB 5 nUiYNa) 
xP2sX2*310f-*C0 3 
yp2 = V2-3lLJfc*SIN c«2) 

XG2-X2+SlDfc*CaS (H3) 

Y«2sV2*bIOfe'*SIN((H3) 

P fe, T u P f'l 
b PtTUPN i 
End 

► 




r ij W !'< 2 ; 
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NEWPSI 


Required function: 

This routine is used to compute the ground- track parameters of the 
minimum length flight path between two given points; the flight path and 
therefore the ground track is subject to a given initial heading and a 
minimum turning radius constraint. 

Method : 

The desired ground track consists of a circular turn followed by a 
straight-line segment. It is first determined whether the two points are 
(jj^stinct. In the pathological case when the two points coincide, the turn 
is set equal to zero and the intermediate computation as omitted. If the 
two points are distinct, then the direction of the turn is determined by 
noting whether the second point lies to the right or left of the directed 
line that passes through the first point and has the given initial heading. 
When the direction of the turn is known, its center is computed, and it is 
checked whether the second point lies inside the resulting circle. If 
the second point lies inside the circle, a diagnostic message is printed 
and control is returned to the calling program. If the second point is 
not inside the circle, then the three angles ANGLEl, ANGLE2, and ANGLES 
are computed and are used to determine the angular extent of the turn. 

The last step is to compute the arclength, the straight-line heading 
toward the second point, and the x,y-coordinates of the end of the turn. 

Input data: 

XI, Y1 

HI 

R1 

X2,Y2 

Output data: 

TURNl 
DELDl 
XQ1,YQ1 
H2 


x,y- coordinates of the first point, ft 
initial heading at the first point, radian 
radius of turn at the first point, ft 
x,y- coordinates of the second point, ft 

angular extent of turn, radian (-2n < TURNl < 2ir) 
arclength, ft 

x,y- coordinates of end of turn, ft • 
heading of straight line, radian 
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Temporary variables: 

SINHl =sin(H13 

COSHl =cos(Hl) 

DX =X2-X1, ft 

DY =Y2-Y1, ft 

TEMP =]Dx1+1dY|, ft 

XC,YC x,y- coordinates of the center of turn, ft 

SIGN =+l if TURNING; =-l if TURNKO 

SIGNRl =SIGN*R1, ft 

D length of straight-line segment (or its square), ft 

ANGLEl heading of line from center of turn to first point, radian 

ANGLE2 heading of line from center of turn to second point, radian 

ANGLES =tan"^ (D/Rl), radian 

Constants : 

HALFPI =1.5708 

TWOPI =6.28319 

Subroutines required: None 

Called by: THREED and TST 
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HALFPIsi ,b70o 
TwO^Isfe.aeSl*? 
siNHUsiNinn 

COSHlsCQS(Hj) 

DY5Y2-Y1 
OXSX2-X I 

TfcMF'SA8SCUX)<t.ABS(UV} 

IF( TEmP.GT.O, ) Gn TU i 
TURMSO . 
bO TQ b 

1 SIGNSSGN (OY*COSHl ®DX*SlNHn 
SIGNwIssIGNaRI 
XCaXl»SiGNWl*8lNHi 
YC=Yl*SiGNRl*CObHl 

Da(42*XC)*(X2-XC)*f ya-YC)*(Y2-YC)-«l*«l 
IFCO.GE.O,) GO TO 2 

10) xt,X2,Yl,Y2 

10 format (///2X| ' YiAYPOIfYTS TOU CLOSt ' /2F20 , I /2F20 , 1 ) 

GO TO b 

2 DsSOWT(O) 

ANGLEiaPlMOOrHl-SlGN*HAUFPl) 

ANGLE2SAT AN2f Y2-YC, x2-xC) 

TFfSIGM,LT,0,) GO TO i 

IF CANuLt2,LT, ANGLfel ) an&LE2sANGlE2 + T WQP I 
GO TO « 

i IF (ANGLt2,GT, A^GU£1 ) ANGL£2= ANGLE2-TW0P I 
a ANGLFi=ATANCO/«l) 

TgRNl sAN&L£2-ANGLfc l-SlG^*A^tGL£5 
b DtLOl=Wl*AB5(TUHNn 

m2sP I MOD C H 1 ♦ T uR N I ) 

XQlaXC+SIGBRl*SlN(H2) 
vai sVC“bIGN«l *C0S(H2) 

RtTuRN 
t> RfcTuRN 1 
£nO 


JP^-ftiCy4r ft 
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VRANGE 


Required function: 

This routine computes the minimum and maximum admissible airspeeds 
at each specified waypoint. 

Method; 

First the wind component along the ground track at the beginning and 
end of each turn is computed. Then, starting with the last waypoint and 
proceeding sequentially backward, a minimum and maximum airspeed at the 
previous waypoint are generated under the following assumptions: the 

desired minimum and maximum cruising speeds (VLOWER and VUPPER) are main- 
tained as long as possible, at the last waypoint the desired speed VFINAL 
is achieved, and speed changes occur at the maximum rate. 


Input data: 
CURWPl 

NWP 

NWPl 

VW 

HW 

Hi 

VFINAL 

VLOWER 

VUPPER 

MAXDEC 

Output data: 

VMINi, 

VMAXi 

DVWi 


index of waypoint immediately following the capture way- 
point (=CURWPT+1) 

index of last waypoint 

=NWP+1 

estimated wind magnitude, ft/sec 
estimated wind direction, radian 

headings of straight-line segments in ground track, radian 
(i-CURWPl,CURWPl+l, . , . ,NWP1) 

desired airspeed at last waypoint, ft/sec 

desired minimum cruising speed, £t/sec 

desired maximum cruising speed, ft/sec 

maximum admissible deceleration, ft/sec^ (negative) 

minimum and maximum airspeeds at waypoint i,i=l,2, . . , ,NWP 
ft/sec 

component of the wind in the direction Hj^, i=CURWPl, 

CURWPl+1, . . . ,NWP1; ft/sec 
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Temporary variables: 


MAXV 

MINV 

Constants : 
Subroutines 
Called by: 


maximum airspeed at point from which aircraft could 
at a rate MAXDEC and achieve at point P^+i, 

maximum airspeed at point from which aircraft could 
at a rate MAXDEC and achieve VMIN^^^ at point 

None 


required : None 

FOURD 


decelerate 

ft/sec 

decelerate 

ft/sec 
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i = CURWPI 


DVWj = VW^COS(Hj-HW) 


i < NWPt 


i:NWPI 


i = NWP 

VMINj = V FINAL 
VMAXi ^ VFINAL 


VMAXj+i : 
0/UPPER^ 


VMAXi + I < VUPPER 


MAXV = (( VMAX j+, + DVWi+()2-2 * MAXOEC DVWi +, ) - DVWj ^ 


MAXV > VUPPER XMAXV^ 
' ^—^UPPEft 


VMAXi = VUPPER 


VMINj +L 
VLOWER, 


VMIN|+, < VLOWER 


MINV =({ VMINj +, + DVWj +1 )2 -2 X MAXDEC X DVWj +|) ' - DVWi+( 


MINV> VLOWER /ImINVN 
<WLOWER^ 


VMINj = VLOWER 


VMINj = MINV 



RETURN 
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20 


30 


«0 

50 



IbNhP 

VMINC I)sVf INAL 
VMAX ( nsVFiNAL 
1 * 1-1 

IF tVHAX (I+l ) .Gfc, VUPPEN) GO TO ao 

MAxVsSQ«T( (Vf^AX(I*n+OVN(I + n )** 2 - 2 .*MAXDEC*D(Ifl ))-DVw(l + n 
IF(MAXv,6E , VUPPEW) GO TO «0 
VMAXaiaMAXV 
GO TO 50 
VMAX( 1 )sVUPPEH 

IF(VMIN(Un ,GE,VLOwEP) GO TO 60 

MINV»S0PT<(VMlNn4n+0VW(I + l))**2-2,*MAX0£C*0CI'*’lJ)-0Vw(I + i) 

If (MINV.GE , VUONEP) 60 TO 60 
VMlN(I)sHINv/ 

GU TO 70 


60 VMIN(I)8VL0wER 
70 IFd.GTaU GO TO iO 
RETURN 
END 


OEiGINiL iPAGJi ^ 
OF POOt ^ otfALITY 
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TRANCE 


Required function: 

The routine computes the minimum and maximum feasible flight times from 
each waypoint to the last one. 

Method: 

The minimum and maximum flight times are computed by use of subroutine 
TRANS. Starting with the last waypoint and proceeding sequentially back- 
ward, RO is first set to zero. This implies the maximum feasible speed 
profile; calling TRANS generates the corresponding minimum flight time 
between adjacent waypoints. RO is then set to 1 and the process is repeated 
for the maximum flight time between adjacent waypoints. 


Input data: 

CURWPl index of waypoint immediately following the capture waypoint 

NWP index of last waypoint 

Also, all inputs required for subroutine TRANS. 


Output data: 


TMINi 


TMAXi 


minimum feasible flight time from 
point Qj^) to last waypoint (to 


waypoint i (actually, 
point sec 


from 


maximum feasible flight time from 
point Q^) to last waypoint (to 


waypoint i (actually, 
point sec 


from 


Temporary variables: 


RO 

TI 

Constants : 
Subroutines 
Called by; 


(see input data for TRANS) 

flight time from point Qi-j to point corresponding to a 
particular value of RO (TI is the output of TRANS) , sec 

None 

required : TRANS 

FOURD 
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SUSROUTINt trance 

CO*^MON Pl,TwOPl,(i,RAOOeC,GTANFl,NwP,HFlNAl.,GFINAL,VFINAL#HW,VW, 

IMAXPHI ,MAXGAM,fUNGAM,HAXACC.MA)rC>EC»PHIDOT, V3NF , V SFF , VUPPER # 
2VLO»<eK,CU«wPT,CURwPl,NWPl, I,P0, TI,XAC,yAC,ZAC,HAC,VAC,MAXSEG/ 

5CAPS£S»0AC»TURNAC»RAC»0fcL0AC» XOAC, VQAC#ZC)AC,HwP,GAMwP,DinP,XPWP, 

4YPWP, ZP«P, Turn hP,R»/P,OELO«P» XIJWP, YOwP, ZQwPf 1 NOE X (i0),XK'P(^0), 
5YwP(20) iZwPcaojfRCaO) ,H(2l ),GAM(2l) f D(20),XP(20)»YP(i*0) f ZP(20J , 
6TURN(20),oeLO(20),XQ(20),YQ(20),ZQ(20),VHIN(20),VMAx(20),VA(20), 
7VP(20),VQ(20),OVWC2n»TMlN(20),TMAX(20),ENRTIM(20),CRCO(20), 

STin (20) |TI12(20) ,TI22(20) , TI23C20) ,TU»Tl2,T22,T23,TIMkEF CBO) , 

RTRNWEF(80) .GAMREP (80 ),ACCREF(SO),TLtAOT(20)»TLEAD5(20)jTLfcADP(20) 
REAL MAXPHI,haXGAM,MINGAN,MAXACC,MAXDEC 
INTEGER CURwPT.CUHwPl ,CAPSEG,C«CD 
I sNixP 

TMIN(I)«0. 

TMAX(I)*0, 

10 RO«Oi 

CALL TRANS 

TMlN(I»n*TNlN(I)+TI 
RO*l , 

CALL TRANS . 

TNAX(I-l)aThAX(I)+TI 
IFCl.LE.CURwPn RETURN 
IBI-I 
GO TU 10 

END 
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SPEED 


Required function: 

The purpose of this routine is threefold- First, the value of RO that 
yields the desired flight time from the capture waypoint to the last way- 
point is determined* This is accomplished by an iterative process- Once 
the proper RO is found, the 4-D reference commands are assembled in a 
chronological sequence* Finally, the appropriate lead times are computed 
to compensate for finite roll and pitch rates. 

Method: 

The iterative procedure to find RO starts with an initial value and 
computes the corresponding flight time from the capture waypoint to the last 
waypoint. If the resulting flight time differs from the desired value by 
more than 1 sec (arbitrary) , then RO is updated and the flight- time compu- 
tation is repeated. 

After the correct value of RO is found, the 4-D reference commands 
are assembled between each pair of adjacent waypoints, starting with the 
capture waypoint and proceeding to the last waypoint. This operation 
results in four arrays that contain the sequences of piecewise constant 
4-D guidance commands for the entire flight path. Note that any command 
whose time duration is less than 0. 1 sec was omitted from the final 
sequence. 

The last block of computations for each waypoint involves the deter- 
mination of the appropriate lead times for finite roll and pitch rate 
compensation. Since the lead time for roll-rate compensation depends on 
ground speed, and since the ground speeds at the beginning and end of a 
turn are generally different, two lead times are computed for each turn - 
one applies to the roll into the turn, the other, to the roll out of the 
turn. 


Input data: 




CURWPT 

index of capture waypoint 



CURWPl 

=CURWPT+1 



NWP 

index of last waypoint 



™^^CURWPT 

minimijm feasible flight time 
the last waypoint, sec 

from 

the 

^^^CURWPT 

maximum feasible flight time 
the last waypoint, sec 

from 

the 


capture waypoint to 
capture waypoint to 
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ENRTIM desired flight time from the capture waypoint to the last 

waypoint, sec 

QPQjj index of the reference command applied at the capture way- 

CURWPT point; this variable initializes a pointer for the 

sequence of 4-D reference commands 

MAXACC (MAXDEC) maximum admissible acceleration (deceleration), ft/sec^ 

R. turning radius at waypoint i, ft 


TURN^ 


VPi(VQi) 


PHI DOT 




direction and extent of turn at waypoint i, radian 

flight-path angle from point Qj^_j to point radian 

ground speed at beginning (end) of the turn at waypoint i, 
ft/sec 

maximum admissible roll rate, radian/sec 

desired airspeed at last waypoint, ft/sec (same as 
VFINAL) 

(see output data of subroutine VRANGE) 


Also, all other inputs required for the subroutine TRANS. 


Output data: 


ENRTIM. 


ACCREF, 


TRNREF, 


GAMREF, 


flight time from waypoint i (from point Qj^) to the last 
waypoint, sec 

ground speed at last waypoint, ft/sec 

constant value of the reference rate of change of air- 
speed during the kth command interval, ft/sec^ 

constant value of the signed reference turning radius 
(or its inverse) during the kth command interval, ft 

constant value of the reference flight-path angle during 
the kth command interval, radian 


TIMREF, 


time duration of the kth command interval, sec 


TLEADT. 


lead-time compensation for finite roll rate prior to 
rolling into the turn at waypoint i, sec 


TLEADS^ 


lead-time compensation for finite roll rate prior to 
rolling out of the turn at waypoint i, sec 
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TLEADP^ 

lead-time compensation for finite pitch rate prior to 
changing flight-path angle front to at 

waypoint i (actually at point , sec 

CRCDi 

index of the reference command applied at waypoint i 
(actually at point 

MAXSEG 

total number of nondegenerate guidance commands needed 
to generate the complete 4-D flight path 

Temporary variables: 

RO 

(see input data for TRANS) 

TRO 

flight time from the capture waypoint to the last way- 
point corresponding to any given value of RO, sec 

Till, TI 12, time duration of the four guidance intervals from point 

TI22,TI23, Qi-i point corresponding to any given value of 

RO, sec 

ERROR 

difference between desired flight time from the capture 
waypoint to the last waypoint and that corresponding 
to any given value of RO, sec 

Constants: 


G 

acceleration due to gravity, 32.172 £t/sec^ 

Subroutines 

required: TRANS 

Called by: 

FOURD 

. V. ■ ■ 
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SUBKOUTJME SPEED 

COHMON PI,TW0PI#G,PADDED»GTANFI ,NwP,HFlNALf GFjNALf VF INAt f HW, V w, 

imaxphi,maxgah,mincam,maxacc»maxdec»phidot,vsnf, vsff,vuppek, 

2VU0wEH*CUHt'*PT»CUPwPl»NWPl,I»PO>TI»XACiVACfZAC»HAC»VAC»MAXSE&» 

3CAPSEG,DAC, TURNAC,RAC,DELDAC,XOAC» VuiAC,ZQAC,HWP,GAMwP,UWP, XPWP, 

aypWPpZPwP*TURNWP,RwP,0£LOwP, XQi«P, YOWP, ZQWP# INDEX (20) , xwp(20) , 
BYt«(P( 20 ) » ZWP (20) p«(20) pHC21) ,GAM(2n ,0(20) ,XP(20)»yP(20)pZP(20)» 

6TUPN(20),DELD(20),XQ(20),Y8(20),ZG(20),VMIN(20),VMAx(20),VA(20), 

7VP(20) , VO(20),OVW(21),TMIN(20),TMAX(20),ENRTIMC20),CRCO(20), 
bTni(20)iTIl2C20)#TI22(20), TI2 3(20), Til, T12,T22»T23,TIMHEF(<30), 
9TRNHEF (00 ) pGAMREF ( BO ) , ACCREF ( 80 ) , TLE AOT (20 ) , TLE ADS ( 20 ) , TLt ADP (20 ) 
REAL HAXPHI,RAXCAM,MINGAM,MAXACC,MAXDEC 

Integer currpt,curwpi ,capseg,crcd 
R0»0,5 

IF(TMAX(CURRPT)*TMIN(CURRPT) ,GT,l .) 

IR08(ENRTIM(CURWPT)«TMIN(CuRwPT) )/ (TMAx(CURWPT)«TMIN(CU«wPT) ) 

10 laCuRwPl 
TRObO, 

20 CALL TRANS 
TRObTROtTJ 
Till (I) bTII 

TI12(naTl2 

TI22(i)«T22 

TI23(I)bT23 

ENRTIM(n«£NRTIM(l-l)-Tl 
IFd.GE.NwP) GO TO 30 
IBI + I 
GO TO 20 

30 ERROR»ENRTlH(CUHWPT)*TRO 

IF (A8S(ERR0R),LT.l.) 60 TO «0 

ROaROtERROR/ (TMAX (CURRPT)-TMIN {CuPwPT ) ) 

IF ( A0S(«O-O ,5) .GT.O.S) RQa ( I , tSGN (RO-0 , 5) )/2, 

GO TO 10 

«0 KbCRCD(CURRPT) 

VQ(NWP)»VA(NWP)tOVW(NwPl) 

DO 90 IaCURwPl,NRP 

IF(TIll(n,LT,0.n GO TO 50 
ACCREF(K)sO, 

TRNHEF(iObO, 

GAMREF (K) aGAM( I ) 

TlMREF(K)aTIU (I) 

KsK + l 

50 IF(TI12(I) .LT.O.l) GO TO 60 

ACCREF (K)sNAXDEC 

IF(VA(I),GT,VA(l-n) ACCREF(K)«flAKACC 



<50 


70 


00 


90 


TkNkEF f K ) sO, 

Tif^kef (K)sTiii(n 
KsK+l 

iF(U2^(n ,UT,Q.l) GU TO 70 

ftCCHtF(fs3=0« 

TRNkfcFCKlsO, 

GAMke.F CK)=GAM( I ) 

7 iMRtF fK)sTI2ci{n 

K=K + 1 

iF(T12i(n.LT.0.n GU TO 00 
ACCkEF fK) = 0 , 

TkNktF(K)sSGN(Tu«N(n)*k(I) 

GAMREF fK)sGAH(I) 

TiMREF(K)sTl2J{I) 
ksK 1 1 

TLfcADT ( I )SA7AN( (vP(I) *0P( I) ^ /fG*k( I) n / 

Tlc.AUS(I) = ATA^((VU(n*viUI))/fG*r((n))/(<it*P'iIDOT) 
TLtAUP(I)5A0S(GAM(l*n*G4M(I)^*OQ(n/R,5 
CRCotnsK 
maxSEGsK'I 
RETURN 
EnO 
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TTTURN 


Required function: 

Given the parameters of a circular turn (i.e., initial and final headings 
and turning radius), the magnitude and direction of the estimated wind, and a 
desired constant airspeed during the turn, this routine computes the time 
required to complete the turn. 


Method : 

The time spent during the turn is given by expression (87) . Since the 
tan“^ (•) functions in (87) are one-to-many, additional logic must be incor- 
porated to arrive at the correct result. The final values of BETA2 and BETAl 
represent the first and second tan“^ (•) functions on the right side of equa- 
tion (87), respectively. 


Input data: 



HSTART 

initial heading at beginning of the 

turn, radian 

TRN 

direction and angular extent of the 

turn, radian 

RTRN 

radius of the turn, ft 


VWIND 

magnitude of wind, ft/sec 


HWIND 

direction of wind, radian 


VAIR 

desired constant airspeed during turn, ft/sec 

Output data: 



TRNTIM 

time spent during the turn, sec 



Temporary variables: 

Cl ground speed corresponding to the given airspeed and wind 

when the aircraft heading is parallel to the wind head- 
ing, ft/sec 

C2 ground speed corresponding to the given airspeed and wind 

when the aircraft heading is perpendicular to the wind 
heading, ft/sec 

ALPHAl difference between initial heading and wind direction, radian 

ALPHA2 =ALPHA1+TRN, radian 
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BETAl 


BETA2 

Constants: 

PI 

TWOPI 


value of the second tan“^ C*) function in equation (87), radian 
value of the first tan"^ (*) function in equation (87), radian 


=3.14159 

=6.28319 


Subroutines required: None 

Called by: TRANS, TST 



(^ ttturn ^ 
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subroutine tT'^TUkNCHSTaHT/TBN»RTKN,VWInO,hi*»!nO#V4IR»TWnT1M) 

PI*3, iai59 
T--0PI^6.^8319 
C iBVAlR+VwiNO 

C^sSQRT(VAIR*v■AIR*''^wIf^O*Vi«tI^D) 

ALPHA IsHSTART-HwIND 

( AB&f ALPHA U ,6T, PI ) AL PHA 1 sALHH A 1 -SQN ( ALPH A 1 ) * T wOp I 

8tTAl5ALPHAl/2, 

IF f HI /2. -A6S (ritTAD ,GT. 0,000 1 ) bET A 1 s a T AN (Cd* T AN (BE T A U /C H 

ALPmA^sALPHAI +TRN 

8£TABaALPHA^/2, 

IF(ABS{ ALPHA?) ,i,T.PI) 8tTA2aBETA2-SGN( ALPHA?) *PI 
IF(PI/2, -ABS(bfcT A?), GT, 0,0001) bETA?3ATAN(C^*TAN(bETA?)/Cn 
IFCABS(ALHMAg),GT,PI) Q£ T A2 = Bt T A? ♦ SbN ( ALPH A? ) *PI 
TRNTlH=2,*RTRN*SGN(TRN)*(Bt T A2-bETAl )/CB 

RETURN 

end 





TRANS 


Required function: 

Given a value of i,2<i<NWP, certain parameters of the 3-D flight path 
between waypoints (i-1) and i, the minimum and maximum airspeeds VMIN^ 

VMIN^,VMAX^_j ,VMAX^, and a specific value of RO, this routine computes the 

transfer time from point ^ to point Q^. 


Method : 

First the airspeeds at waypoints i-1 and i are computed using the 
minimum and maximum admissible airspeeds and the speed level parameter RO. 
Then the corresponding ground speeds at the beginning and end of the straight 
flight segment are determined. Next, the parameter RO is used to determine 
the point in the straight flight segment at which the necessary speed change 
should begin. Once the lengths of the constant speed and constant speed- 
change segments are known, the corresponding time durations are calculated. 

In order to determine the flight time during the turn, subroutine TTTURN is 
called. 


Input data: 


i waypoint number indicating the second of a pair of 

adjacent waypoints between which the transfer time 
is to be computed, 2<i<NWP 


VMIN (VMAX. ) minimum (maximum) admissible airspeed at waypoint i-1, 

ft/sec 


VMIN. , VMAX. minimum (maximum) admissible airspeed at waypoint i, 

ft/sec 


RO 


DVW. 

1 

MAXACC(MAXDEC) 


fraction indicating speed profile deviation from maxi- 
mum admissible speed profile, 0<RO<1 

component of wind along the heading ft/sec 

maximum admissible acceleration (deceleration), ft/sec^ 


D. 

1 

H. 

1 

TURN. 

1 


length of straight-line segment from point Q. to 
point P^, ft 

heading of straight-line segment from point Q. to 
point P^, radian 

direction and magnitude of turn at waypoint i, radian 
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R. 

1 


radius of turn at waypoint i, radian 
wind magnitude, ft/sec 
wind direction, radian 


VW 
HW 

Output data: 

VA^ ^,VA^ airspeeds at waypoints i-1 and i, ft/sec 

VQ^ 1 *^^i ground speeds at points Q^_i ft/sec 

Til durations of straight flight flown at constant ground speed 

VQ. , , sec 

T12 duration of straight flight during which speed is changed 

from to VP^, sec 

T22 duration of straight flight flown at constant ground speed 

VP. , sec 
1 

T23 duration of curved flight flown at constant airspeed VA^, 

sec 

TI duration of flight from point Q^_j point Q^, sec 

Temporary variables: 

A12 rate of change of speed occurring in straight flight, ft/sec^ 

S12 distance required to change speed from to VP^ at a 

rate given by A12, ft 

S22 length of straight flight flown at constant ground speed 

VP., ft 

- , Tv 

Cons t ant s : None; vi ■ 

Subroutine's required':- TTTURN 
Called by: TRANCE and SPEED 
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SUflkOUTINe TfiANS 

COMMON PI,TwOPI»G*»ADDEG*GTANfI,NwP,HFlN4L»(>PIMAL>VFlNAL»M>>(,Vw, 
lMAXPHl,MAKGAM,MiNGAM,MAx4CC»M4Xi)F.CiP'^I0ClT*Vi>Nf ,VS^F ,VuPPFP» 
2VLOw£R,CUftwPT,CUPwPl*Ni*'Pl»I»Pf-*»Tl»XAC,YAC.*ZAC,HiC,V/dC,MAXSfeG, 
iCAPb£G,uAC,TU«NAC,«AC,DtLOAC,XQAC,-Yt.iAC.2(5AC,MwP,GAMwP,Di^P,XPWP, 
ttYPi»/P»i:PwP,TuWN“iP»KWp,uELO^P»x:«.^M#YQ>^P,ZU'^P/INO{:Xf(20)*XwP(<JO)» 
^YwPt?0),ZwPCP0)»MC?0'5»M(2n#&A'^(21^»{^(20)»XP(20)»yP(2o)»2P(«i0)» 
6TUWN{20j,PEUO(205/Xw(20),YaC20),ZQ(20),VMlNt^u),VMAX(20)»VA(2ai, 

7VPf20)»Vf3(20}*OVW(?l)#TMlN(20). »TMax(20)»FNR1IM(20)»CPCO(?0)« 

8TIlU20)#Tn2(20),n22(20),n2 5(20)#Tll,Tia,T2P,T^3,TiMktPC60), 
PTPNPEPfe0)»GAMP£FC60)»ACCPEP(fc0)»TLtAOT(20)fTL£AOSr20),TLtADP(cU) 

PEAL M AXPhI , MA XO AM , M INGaM , M AX ACC » M A XDEC 
INTEGEP CuPi^PTiCUPwPl^CAPSFGfCRCO 
VAfI-n=y/MAx(I«n»PO*(VMAxfI»l)»YHlN{I«ll) 
VA(i)=VMdXCI)-RU*(YMAxn)-YMlfv(l)) 

Vv3f I- 1) »YA( I- n +DVM( I ) 

VP(l)=VACiWOVk(n 

AUsMAXOEC 

lP(vP(l),GT.VQn-m A12SMAX4CC 

Sl25(VP{r)*VP(l)-VQcI-n*Vf^'lI-U)/(2.-irAi2) 

S2? = PU* (Dcn«S125 

Tl l5(u(n-Sl2-S22)/vfJ(l-t ) 

Tl2=(vP(I)-vQ(I-l))/Al? 

T^P = S^P/VP f i ) 

CALL T T r U P N ( H ( I ) , T UP N c I ) , P ( i ) , V . HW , V A f n » T 2 5 ) 

TI = n 1*T12 + T?2 + T?3 

Pfc TuPn 

END 


OF POOR QUAUi)^ 
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TST 


Required function: 

This routine is used to generate a 4-D capture flight path from the 
current aircraft state to one of the waypoints (capture waypoint) on the pre- 
computed flight path. 


Method: 

The capture flight path is computed in several distinct stages. After 
proper initialization, subroutine NEWPSI is used in an iterative fashion to 
generate the ground track. If at any stage of the iterative process the 
ground track is not feasible (because the aircraft is located too near the 
capture waypoint) , a diagnostic message is printed and control is returned to 
the calling program. 

After the ground-track parameters have been computed, the constant flight 
path angle is determined. If this angle falls outside the permissible range, 
a diagnostic message is printed and control is returned to the calling 
progreim . 

Next it is checked whether the ground track (its straight segment) is 
long enough to allow the required speed change. If not, a diagnostic message 
is printed and control is returned to the calling program. 

The last stage of the process generates the sequence of 4-D reference 
commands for the capture flight path and the lead times associated with the 
capture waypoint. This stage is analogous to the last stage of subroutine 
SPEED. 


Input data: 

XAC,YAC,ZAC 

HAC 

VAC 

CURWPT 

VW 

HW 

xQcurwpt ) 
yQcurwpt f 
ZQcURWPT j 


x,y, z- coordinates of aircraft position, ft 

aircraft heading, radian 

airspeed of aircraft, ft/sec 

index of the capture waypoint, 1<CURWPT<NWP 

wind magnitude, ft/sec 

wind direction, radian 

x,y,z- coordinates of capture waypoint (actually of the 
end of the turn associated with the capture way- 
point) , ft 
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V^URWPT 

tICURWPl 

MINGAM(MAXGAM) 
DVWcurWPI 
MAXACC CMAXDEC) 

PHIDOT 

vQcurwpt 

GAMCURWPI 

Output data: 

TURNAC 

RAC 

DELDAC 

XQAC,YQAC,ZQAC 

\ 

VQAC 

HWP 

GAMWP 


airspeed at capture waypoint, ft/sec 

heading o£ straight-flight segment immediately fol- 
lowing the capture waypoint, radian 

minimum (maximum) admissible flight-path angle, radian 

wind component along the heading ft/sec 

maximum admissible acceleration (deceleration) , 
ft/sec^ 

maximtun admissible roll rate, radian/sec 

ground speed at the end of the turn associated with thi 
capture waypoint, ft/sec 

flight-path angle immediately following the capture 
waypoint, radian 


direction and magnitude of first turn in the capture 
flight path, radian 

turning radius of first turn in capture flight path, ft 

arclength of TURNAC, ft 

x,y,z- coordinates of end of first turn in capture 
flight path, ft 

ground speed at end of first turn in capture flight 
path, ft/sec 

heading of straight segment in capture flight path, 
radian 

constant flight-path angle of the capture flight path, 
radian 


DWP 

XPWP,YPWP,ZPWP 

TURNWP 

RWP 


length of straight segment in capture flight path, ft 

x,y, z-coordinates of beginning of second turn in 
capture flight path, ft 

direction and magnitude of second turn in capture 
flight path, radian 

turning radius of second turn in capture flight path, 
ft 
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DELDWP 


arclength of TURNWP, ft 


XQWP,YQWP,ZQWP 

VPWP 

ACCREF^ 

TRNREF]^ 

GAMREFj^ 

TIMREFj, 

TLEADTi 

T LEADS 1 

TLEADPj^ 

CAPSEG 

Temporary variables: 
VWP 
HH2 
HHl 

TEST 

DUMMY 

A12 


x,y, z-coordinates of end of second turn in capture 
flight path (same as ^QcuRWPT’^^URWPT’^^URWPT^ ’ 

ground speed at beginning of second turn in capture 
flight path, ft/sec 

constant value of the reference rate of change of 
airspeed during the kth conanand interval, ft/sec^ 

constant value of the signed reference turning radius 
(or its inverse) during the kth command interval, ft 

constant value of reference flight-path angle during 
the kth command interval, radian 

time duration of the kth command interval, sec 

lead-time compensation for finite roll rate prior to 
rolling into the turn at the capture waypoint, sec 

lead-time compensation for finite roll rate prior to 
rolling out of the turn at the capture waypoint, sec 

lead-time compensation for finite pitch rate prior to 
changing flight -path angle from GAMWP to GAMcurwpi 
at the capture waypoint, sec 

total number of nondegenerate guidance commands needed 
to generate the 4-D capture flight path, 1<CAPSEG<4 


airspeed of capture waypoint, ft/sec 

reverse of heading radian 

heading of straight line generated by NEWPSI the first 
time it is called in the iterative process, radian 

variable that measures the convergence of the iterative 
process generating the ground track of the capture 
flight path, radian 

wind component along the heading HWP, ft/sec 

rate of change of speed occurring in the straight- 
flight segment of the capture flight path, ft/sec^ 
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S12 


distance required to change speed from VQAC to VPWP at 
a rate given by A12, ft 

TA time duration of any one of the command intervals in 

capture flight path, sec 

Constants : 

PI =3,14159 

G acceleration due to gravity, 32,172 ft/sec^ 

GTANFI =G*TAN(MAXPHI) 

Subroutines required: NEWPSI and TTTURN 

Called by: FOURD 
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SUBHOuTINt TST(*) 

COMMON PI ,TW0PI ,G,RaDUEG, 6TANF1 ,N,^P,HFlNtL/OFINAL, VFlNAL#HW,Vw, 
IMAXPMI ,MAX5AM,M INGAM, MAX ACC, maXO£C»PM 100T, VS NFfVSFF/VuPPtP, 

2VL0»«£H,CURMPT ,CUfi'NPl ,Nwpl , I , RO» 1 1, XAC,yAC#ZAC,HAC» VAC , maXS£G» 

3CAPS£G»0AC,TUftNAC,fiAC,D£L0AC,XQAC,YQAC,ZQAC,HwP,GAMWP,0NP,XPWP, 

i»ypWP,ZPMP»TURNWP,«i«(p,i;ELDrtP/ XQWP, yowp, ZQWP, index (20}, XwP(20), 
5VnP( 20) »Z^P(20) »K(20 5 .HC2n »GAM(21) #0(201 »yP(20} , VP(20) ,ZP(20) f 
6TURN(20),OELO(201 »XQ(20),yQ(20}»ZQ(20) #VMIN(20-),VMAX<20) . VAC20) , 
7VP(20),VQ(20),DVW(2l},TMlNt20),TMAX(20),ENR7lM(20),CRCDC201, 

6T I U (20 ), n 12 (20 1, T 122 ( 20 ), TI23 ( 20 ),T 11, Tl 2, T22,T23,T I MkEF (60), 
9THNftEF(BO),GAMR£F(801,ACCHEF(bO),TLfcAOT(20),TL£AOS(20) ,TLEAOP(201 
REAL MAJiPHi ,MaXGAM,MINGAM,MAXACC,MAXDEC 
INTEGER CURkPT,CURWPl,CAPSEG,CRCO 
RACa(VAC + Vk)*( VAC + V#*) /GTANFI 
XuACbXAC 
YQAC*yAC 
VWP«VA(CURWPT) 

XQWP*X0(CURWPT ) 

YQkP«yo(CuRwPT) 

ZQkP«ZQ(CURwPT1 

R*ilPs(VWpfVlN)*(VWP^VM)/GTANFl 

HH2sPIMU0CH(CURwR1UPI ) 

10 CALL N£kPSI(xQwP, YawP,HM2,RwP,XDAC, YQAC,TURNWP,D£LOkP,XPWP, YPkP, 
1HH1,&100) 

CALL NEWPSI (XAC,yAC,MAC,RAC,XPWP, YPWP,TURNAC,OELOAC,XijlAC, YttAC, 
IHwP, 8,100) 

TEST«a88(PI-ASS(MwP«MHI) 1 
IF (TEST, GE. 0,02) GO TO 10 
TURNWP*«TURNWP 

OkPsSQRT ( (XPNP»XQAC)**2Y(yPkP«Y(JAC)**2) 
GAMwPa(ZAC-ZQkP)/(OELOAC+OwPFOELOkP) 

IF (CAMNP,Lt,MAXGAM,AN0,GAMNP,6£,MiNGAM) GO TO 20 
WRITE(6, 15) 

15 FORMAT (///2X, ‘GAMMA OUTSIDE RANGE') 

GO TO 100 

20 OUMMYsVw*COS (HWP-MR) 

VOAC»V AC+OUMMY 
VPWPXVWP+OUMMV 
VOWP*VWPADVi»>(CURkPl) 

A12SMAX0EC 

IF(VPRP,GT,V(3AC) A12XMAXACC 
S12«(VPWP*VPWP-VQAC*VGAC)/(2,*A12) 

IF(S12,LE,OwP) go to 30 
wRIT£(6,25) 

25 FORMAT C///2X ,» DELTAV TOO LARGE') 
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(,0 TO li^O 

SO ZO*l,«.i!*C-0feL0iC*Q.At-'AP 
2PA'P5Zf?iC-0r.P«?»i^wP 
-‘Sl 

UO CALL !TTvJ><^<(HiC,T;jMi!'gfiL»i<AC»V>K,Hi»»,vAC»TA) 

IP rTA,LT.o,n PC 10 '=>0 
ACLWi:P(^)S0, 

TWN^fcPCK'ISSP^fTljK^ACjitpAC 

>OAM«tP‘ (ft ) a(, AM^P 
1 lMHtP(l<)5TA 
K = tt+ 1 

SO T i= (DisP-SU ) / VQAC 

IP n a,l r , 0. n GO TO hQ 

ACC'^tP C<)=0, 

TPNPtP’(‘t}sO, 

0 AMWfcF ( K ) =(., AHwP 

1 iMWt P ( -< ) =T A 

KS(\ ♦ 1 

^>0 T AS (? , 1 £ ) / (■ vQdC + VPwPT 

IP ( fA.U ,0, n GO TO 7 0 

ACC«ftF (K )si 12 

TWnWlF (K) so, 

OAMPfeF (K)«G«'^wP’ 

TlM«(iF(K)sTA 

K = K+ 1 

70 CALL TTTUKiN(H^P,Tu^NwP,P^P,VW,HW,\/wP,TA) 
lP(TA,LT,0.n GO TO 80 
ACC»tP(K)sO, 

TRnRcF ( K ) sSGn ( TUk\’^P ) *KiNp 
0AMrttF(K)3GAi*!i«(P 
T IMPLF (X ) = T A 
KS^ + l 

80 CAPaEo=s-l 

TLfcADTfl) = ArA?g((VP^P*VP-P)/(G*«,vP)l/T2.*PHluOT) 

TlF ADSn UAT An{ ( Ou (CUP«PT) *vO (CUP>nPT ) )/(Gi‘K.f(P))/(2,*PhIuC>n 
TL£AOHfl5 = AbS(rjAM(Cu«»iPl)'-GAPiwP)*yQ(CijWwPT)/u,S 
P t T y P In 

100 PfcTuWN 1 
END 


MIOmAL PAGE IS 

W* POOR QDAUTV 
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PIMOD(XYZ) 


Required function: 

This function converts an arbitrary angle XYZ to the equivalent angle 
within the range -Tr<XYZ<Tr. 


Method : 

If XYZ > Tr, it is decreased by 2n decrements until it falls within the 
desired range. If XYZ s -tt, it is increased by 2tt increments until it falls 
within the desired range. 


Input data (argument) : 

XYZ any angle, radian 

Output data (value of function) : 

PIMOD(XYZ) -it<PIMOD(XYZ)<¥ 

Temporary variables: None 

Constants: 


PI 

TWOPI 

Subroutines required: 
Called by: 


= 3.14159 

= 6.28319 

None 

THREED, NEWPSI, and TST 
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Pu^CTI^N FiMno(xYZ) 

Pl*i. 

Tl^nPIst,, 26319 
PIMODsXYZ 

10 IF (PlKOO.tQ.Pl ) PtTuPN 
IF (Pl!<<OD,LT,Pn GO TO 20 
PIf^Q03PIM0D*Tw0PI 
GO TO 10 

20 IF fKlMOO,GT,-Pn RETURN^ 
PIhOD8P1mOD*TWOPI 
GO TO 20 

End 


^^IGDiAi PAr^ - 



SGN(XYZ) 


Required function: 

This function generates the sign of its argument. 

Method : 

If XYZ i 0, the value of the function is set to +1; if XYZ < 0, it is 
set to -1. 

Input data (argument) : 


XYZ any number 

Output data (value of function) : 

cpwrYY7'l - XYZ > 0 

SGN(XYZ) - m<0 


Temporary variables: 

None 

Constants : 

None 

Subroutines required: 

None 

Called by: 

ROUND, NEWPSI, SPEED, TTTURN, and TST 
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Function ssNtxv^) 

SGNs 1 , 

IKXYZ.LT.O. ) SUNS-1, 

RtTu«N 

END 


ORIGINAL PAGE IS 
OF POOR QUALITY 
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CAtl Frill RO 


hAXPHI 

= 

30.0 

MAX GAM 

= 

16.0 

M I MG AM 

ts 

-7.5 

MAX ACC 

- 

1.0 

MAXDFC 

- 

-1.0 

phiomt 

= 
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VSi^F = 

1 60 

.0 

VSFl- == 

1?0 

.0 

CUPPER 
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1.7 

Cl.nWER 

= 
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o o 
^ & 

^ c 5 


W 

Is 

g” 


NWP = A MF INAL 


0#0 GFINAL 


O.O VFIMAL 


13S.0 HH 


IBO.O VW 


0.0 


IMOEX( n 

XKPd ) 

YWPU 1 

2wpn ) 

PAD 

1 

7500.0 

fiOOO.O 

-3^40.0 

0.0 

0 

23000.0 

fiOOO.O 
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0 

P3000. 0 
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0 
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0.0 

1 
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0.0 
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1 

-^oon.o 

0.0 
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0.0 


H< 1 ) 
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01 n 

XP(1 1 
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Pi ! ) 

OFLOd ) 

X0( I ) 

YOU 1 

20t 1 1 
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4000. 0 

6283.2 

23000.0 

4000.0 
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-90.0 

4000.0 

6283.2 

10000.0 
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0.0 

-17000.0 

-8500.0 

-3240,0 
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19 A .0 

) 92 .0 

19;?. 0 


13 b . 0 


TMINM I ) 

TMAXn J 


^B3.0 

3 3^.6 

39] .8 

^7B.b 

316.0 

1 30 . 1 

1 3 0 . b 

b7.9 

38.3 

0.0 
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VA(1 ) 

ENRTIMI n 

CRCon ] 

?3S.O 

A06.3 ^ 

5 

355.0 

336.5' 

7 

355.0 

378.5 

9 

iOA.O 

130.1 

11 

197^0 

57.9 

16 

135.0 

-0.0 

1 6 


Tl^Kf'F(K) 

TRNHEFiKl 

GAKREFIK) 

ACCPFF IK) 

65.1 

0,0 

0.0 

0,0 

26.6 

-6000.0 

0.0 

0,0 

33.3 

0.0 

o.n 

0,0 

26,6 
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0.0 

0,0 
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n.o 
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0,0 
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0.0 
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-1,0 1 , 
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0,0 . 

O.c, 

0.0 
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0.0 

57,0 

0.0 

-6.0 

-1.0 
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TLEADS{1 » 

TLEAOPC I ) 
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H 
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D 
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K 
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YO 
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^4.6 

3500.6 
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